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ABSTRACT 

The  usefulness  of  remotely  controlled  manipulators  is 
increasing  as  the  need  grows  to  accomplish  complex  tasks  in 
hazardous  environments  such  as  the  deep  ocean. 

The  best  sensory  input  currently  available  to  the 
operator  of  a  remote  supervisory  controlled  manipulator  is  a 
television  picture  of  the  manipulator  and  its  surroundings. 
Very  often  optical  opacity  due  to  suspended  particles  in  the 
water  can  make  television  impractical  or  impossible  to  use. 
This  report  investigates  the  use  of  touch  sensors  to 
construct  a  picture  of  the  manipulator  surroundings.  One 
method  studied  was  to  find  3-d imensional  surface  points  and 
show  them  on  a  computer  graphic  display.  An  extension  of 
this  was  to  reconstruct  the  surface  of  these  points  with  the 
aid  of  a  computer. 

It  was  found  to  be  possible  to  quickly  construct  a 
reasonable  picture  with  a  position  touch  sensor  by  showing 
3-D  surface  points  on  the  graphic  display  and  then  having 
them  rotate  about  an  arbitrary  center.  A  better  picture 
could  be  made  by  reconstructing  the  actual  surface,  but  this 
took  more  computer  time. 

An  informal  evaluation  by  observers  suggests  that  this 
method  offers  practical  advantages  for  "seeing"  objects  in 
environments  where  vision  is  impossible. 
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CHAPTER  1  . 


INTRODUCTION 

Remotely  controlled  manipulators  make  it  possible  to 
perform  tasks  in  hostile  environments  that  would  be 
impossible  or  very  dangerous  for  humans  to  perform.  It  is 
very  difficult  and  expensive  to  send  a  man  down  into  the 
deep  ocean  to  do  a  task.  But  tasks  such  as  exploration, 
salvage,  and  maintenance  of  oil  rigs  must  be  done.  Because 
the  technology  is  not  yet  available  to  make  a  completely 
autonomous  robot,  some  compromises  must  be  made.  A  robot 
can  be  made  as  self  sufficient  as  the  technology  allows  and 
the  higher  order  thinking  can  be  left  to  a  human  controller. 
This  robot-human  system  is  called  Supervisory  Control  and  is 
meant  to  relieve  the  human  of  as  much  direct  control  as 
possible  to  minimize  the  amount  of  required  transmitted  data 
and  perhaps  even  allow  the  robot  to  continue  working  during 
breaks  in  transmission. 

In  human-manipulator  control  systems,  it  is  very 


important 

that 

the  human 

have 

as  much  feedback 

as  possible 

about  what 

is 

happening 

at 

the  manipulator. 

Sight  is 

considered 

to 

be  the  most 

important  source 

of  feedback 

because  it  can  be  readily  understood  by  the  operator.  If 
the  operator  cannot  directly  see  the  manipulator  and 
manipulated  object,  (which  is  often  the  case) ,  some  sort  of 
artificial  vision  must  be  provided.  This  is  most  often  a 
television  picture  of  the  manipulator  work  area.  Television 


provides  the  best  picture  available  but  there  are  some 
problems  that  can  make  television  hard  to  work  with.  Some 
of  these  problems  are: 

1  )  Television  cannot  give  a  reliable  sense  of 
depth  because  it  is  only  displayed  on  a 
2-dimensional  screen.  This  can  slow  the  operator's 
reaction  time  because  he  can  never  be  sure  if  the 
manipulator  arm  or  its  surroundings  are  really  in 
the  place  he  thinks  they  are.  It  is  possible  to  use 
two  cameras  to  get  a  stereo  picture  but  this  kind  of 
display  requires  undivided  attention  and  the 
operator  can  become  fatigued  very  quickly. 

2)  The  raster  picture  on  the  television  screen 
requires  a  massive  data  flow  rate  to  refresh  the 
screen  in  a  reasonable  amount  of  time.  If  the 
operator  is  trying  to  control  a  manipulator  working 
on  the  bottom  of  the  ocean  or  in  deep  space,  the 
data  flow  rate  can  be  very  restricted  by 
transmission  problems.  This  means  the  operator  will 
have  to  live  with  a  fuzzy  picture  or  a  slow  frame 
rate  or  both. 

3)  A  television  camera  must  have  a  clear  view 
of  the  manipulator.  It  cannot  see  anything  in 
turbid  water  and  the  television  must  always  be 
located  so  obstructions  do  not  block  the  view. 
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4-)  In  modern  types  of  supervisory  control 
systems,  a  computer  works  intimately  with  the 
operator  to  control  the  manipulator.  The  computer 
should  have  as  much  feedback  as  possible  made 
available  to  it.  While  a  television  picture  is 
easily  understood  by  a  human,  it  is  meaningless  to  a 
computer  unless  it  has  extensive,  time-consuming 
processing.  A  computer  of  any  control  system  is 
essentially  blind  to  a  television  picture. 

These  problems  show  tne  need  for  investigating  new, 
types  of  viewing  systems  for  use  in  supervisory  control.  A 
system  using  touch  sensors  to  construct  a  simulation  of  the 
surroundings  of  a  manipulator  is  investigated  in  this 
report.  This  kind  of  simulation  can  be  used  to  draw  a 
picture  to  be  viewed  by  a  human  or  can  be  used  to  provide 
3-dimensional  information  to  a  computer  about  the 
surroundings  of  the  manipulator. 
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CHAPTER  2. 


PROPOSED  SOLUTION 


2 . 1  Constuction  of  a  Picture  with  Touch  Senaors 

A  net hod  is  needed  to  improve  visual  feedback  using 
touch  sensors  for  a  human  operating  a  remote  supervisory 
controlled  manipulator.  One  way  is  to  find  the  coordinates 
of  a  large  number  of  points  on  all  the  solid  surfaces  within 
reach  of  the  manipulator.  A  picture  of  the  manipulator 
surroundings  can  then  be  constructed  with  computer  graphics 
by  drawing  a  dot  at  each  location  where  a  solid  surface  is 
hit. 

Points  and  their  coordinates  can  be  found  by  using 
touch  sensors  mounted  on  the  manipulator.  Whenever  a  sensor 
comes  in  contact  with  a  surface  it  could  send  a  signal  to 
the  computer  to  record  the  coordinates  of  the  point  touched. 
The  computer  can  accurately  calculate  point  coordinates  if 
is  given  the  exact  angles  of  the  manipulator  joints  the 
instant  the  sensor  is  tripped,  see  Pig.  2.1. 

A  dynamic  simulation  of  the  manipulator  itself  can  also 
be  added  to  the  display  as  a  reference  if  these  angles  are 


known,  [  1  ] . 

This  means  an 

entire  picture 

of  the 

of 

the 

manipulator 

surroundings 

plus  a  moving 

picture 

of 

the 

manipulator  can  be  made  with  just  information  on  the  values 
of  the  joint  angles  and  indications  of  when  sensors  are 
tripped. 

Very  little  transmitted  data  is  required  to  describe 
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3-dimensional  points  as  opposed  to  a  television  picture. 
Assuming  the  joint  angles  are  to  he  transmitted  anyway,  all 
that  is  needed  to  describe  a  dot  is  an  indication  of  which 
touch  sensor  had  just  been  triggered.  Its  coordinates  can 
then  be  calculated  from  the  joint  angles  given  at  that 
instant. 

A  picture  on  a  3-dimensional  graphic  display  has  the 
same  disadvantage  as  a  television  picture  in  that  it  can 
only  be  shown  on  a  2-dimensional  screen.  But  a  graphic 
display  picture  can  be  viewed  from  any  angle,  something  a 
television  cannot  do  without  having  the  camera  moved.  An 
obstacle  blocking  a  clear  view  of  the  manipulator  on  the 
display  could  be  ignored  by  simply  looking  around  it. 

Also,  because  the  data  of  the  graphic  display  picture 
is  stored  in  three  dimensions,  the  picture  can  be  modified 
to  bring  out  it's  depth  of  field.  Showing  shadows, 
orthographic  views,  and  perspective  will  bring  out  three 
dimensionality,  [l].  Dynamic  pictures  also  bring  out  depth. 
The  three  dimensions  of  the  picture  become  very  apparent 
when  it  is  slowly  rotating  on  the  screen. 

An  advantage  of  having  the  surroundings  of  the 
manipulator  mapped  out  as  discrete  points  is  that  it  can  be 
quickly  interpreted  by  a  computer.  Say  a  task  given  to  a 
computer  is  to  move  a  manipulator  arm  from  one  spot  to 
another  without  hitting  any  obstacles.  If  the  computer  is 
given  enough  information  about  3-D  point  locations  on  the 
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obstacles,  then  it 

could 

be 

programmed  to 

keep 

the  the 

manipulator  away 

from 

the 

surface  points. 

This 

would  be 

easier  for  the  computer  to  solve  than  trying  to  interpret  a 
flat  television  picture. 

2 . 2  Construction  of  a  Surface  ~r jo  Points 

A  problem  with  surface  points  shown  on  a  graphic 
display  is  that  they  give  a  somewhat  ambiguous  indication  as 
to  what  the  surface  is  like  between  them.  Without  the 
surface,  there  is  no  way  to  calculate  volume,  surface  area, 
or  decide  when  something  should  be  hidden  from  view. 

A  method  was  found  to  reconstruct  the  surface  described 
by  a  given  set  of  points  with  the  aid  of  a  computer.  This 
method  will  be  covered  in  some  detail,  as  it  provides  a 
solution  to  the  above  problems  and  also  can  significantly 
improve  the  quality  of  the  graphic  display  used  in 
supervisory  control. 

Computer  graphics  can  never  replace  television  as  a 
sense  of  sight  in  supervisory  control  but  it  could  be  a  very 
useful  aid  to  television  or  even  an  alternative  in 
situations  where  television  is  impossible  to  use. 


CHAPTER  3- 


EQUIPMENT 


3 •  1  Manipulator 

The  manipulator  used  in  this  project  wa3  a  master-slave 
S-2  built  by  the  Argonne  National  Laboratories  for  use  in 
radioactive  environments,  see  Pig.  3» 1 •  The  control  system 
used  in  experiments  was  analog  with  full  force  feedback. 
Control  potentiometers  installed  at  the  servos  provided  a 
signal  for  determining  manipulator  joint  angles.  Interfaces 
between  the  manipulator  and  the  A/D  converter  were  installed 
by  K.  Tani  [2]. 

3 • 2  Computer 

A  PDP  11/34  with  a  RSX-1 1M  timesharing  operating  system 
was  used  for  all  computation.  There  was  a  FP11-A  floating 
point  processor  installed  to  speed  the  fractional 
multiplication  and  division  required  for  real  time  graphic 
transformations  and  simulation. 

3*3  Vector  Graphic  System 

All  vector  graphics  were  done  on  a  Megatek  7000  System. 
It  had  a  resolution  of  4096  x  4096  on  the  approximatly  12  x 
12  screen.  There  was  room  in  the  display  list  for  3000 
3-dimensional  points  or  lines.  This  system  was  capable  of 
hardware  rotations  to  speed  the  cycle  time  for  dynamic 
display. 

Interface  between  the  Megatek  and  computer  was  done 
through  a  user  common  where  all  display  information  could  be 
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stored  until  a  command  w as  called  to  send  the  information  to 


the  Megatek  all  at  once. 

3.4  Analog  to  Digital  Converter 

An  Analogic  5400  Series  was  used  to  convert  analog 
signals  to  digital  for  computer  input.  It  also  had  inputs 
that  could  convert  simple  on-off  signals  to  digital  numbers. 
The  six  analog  channels  giving  the  joint  angles  of  the 
manipulator  could  be  read  in  about  300  microseconds  on  the 
parallel  interface. 

4 • 5  Trackball 

The  Measurement  Systems  Inc.  Trackball  was  connected 
to  the  computer  through  a  serial  interface.  It  had  a 
resolution  of  512  for  360  degrees  of  ball  travel  and  would 
output  the  number  of  units  travelled  between  each  send  to 
the  computer.  The  3end  rate  was  set  by  a  baud  rate  of  9600. 
The  Trackball  was  sensitive  to  motion  around  both  x  and  y 
axes  but  not  around  the  z  axis. 

4-7  Raster  Display 

A  Lexidata  3400  Vidio  Processor  was  used  for  raster 
display.  It  had  a  resolution  of  640  x  512  pixels  with  each 
pixel  having  256  possible  shades.  The  shades  were  stored  in 
a  lookup  table  where  they  could  rapidly  be  changed. 
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CHAPTER  4. 


TOUCH  SENSORS 

A  touch  sensor  is  required  that  will  respond  when  it 
comes  in  contact  with  a  solid  surface  and  has  to  be 
configured  in  such  a  way  that  the  exact  location  of  the 
contact  point  can  be  determined.  Many  different  types  of 
sensor  switching  devices  can  be  imagined.  Switches  based  on 
pneumatics,  stess,  strain,  or  electical  inductance  might 
have  good  applications  in  different  environments  but  for 
experimental  purposes  simple  electical  switches  were  used. 
Whatever  the  sensing  device,  it  must  be  converted  into  an 
electical  signal  for  the  computer.  The  configuration  of  the 
touch  sensor  was  found  to  be  much  more  important  than  the 
actual  sensing  mechanism. 

4 • 1  Best  Conf iguration 

4.1.1  To  Sense  Touch  Direction  or  Surface  Direction 

When  reading  the  three  dimensional  coordinates  of  a 
point  on  a  surface  it  is  also  useful  to  find  a  vector 
pointing  the  direction  of  the  surface  normal  at  that  point. 
This  would  give  valuable  information  about  how  the  surface 
is  structured.  The  problem  is  that  two  degrees  of  freedom 
will  have  to  be  added  to  the  touch  sensor  to  enable  it  to 
read  a  surface  normal,  see  Pig.  4.1.  Adding  more  degrees 
of  freedom  significantly  increases  mechanical  complexity, 


the  amount  of  data  that  must  be  transmitted  to  the  computer, 
and  computation  time.  There  is  another  problem  in  that  the 
surface  normal  would  be  be  found  for  only  one  small  spot. 
The  surface  normal  in  the  immediate  neighborhood  of  the 
point  would  only  be  implied.  The  average  surface  normal 
over  a  larger  area  could  be  found  but  would  be  .  at  the 
expense  of  resolution  of  the  point  location.  The  surface 
normal  could  be  found  more  accuratly  if  the  points  touched 
were  densely  packed,  but  then  the  points  themselves  describe 
the  surface  normal. 

Although  the  ability  bo  sense  the  direction  of  the 
surface  normal  would  increase  the  surface  description 
capabilities  of  a  touch  sensor,  it  was  decided  that  it  was 
not  worth  adding  two  more  degrees  of  freedom.  Since  three 
adjacent  surface  points  describe  an  average  surface  normal, 
it  was  felt  there  was  no  need  to  find  it  for  every  single 
po int. 

It  was  found  to  be  useful,  though,  to  record  the  touch 
sensor  direction  for  each  point.  This  was  actually  the 
center  line  of  the  touch  sensor  at  the  instant  a  point  was 
touched.  The  touch  direction  was  easily  found  because  it 
had  to  be  known  to  calculate  the  coordinates  of  the  point 
anyway.  The  touch  direction  was  useful  because  it  defined  a 
line  that  could  not  pas3  through  the  surface.  This  helped 
to  define  inside  from  outside.  A  series  of  points  on  a 
plane  can  describe  a  surface  normal  but  cannot,  by 
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themselves,  describe  which  side  of  the  plane  is  the  outer 
side. 

4.1.2  Ri^id  or  Flexible  Base 

A  touch  sensor  mounted  rigidly  to  the  manipulator  would 
be  more  reliable  and  accurate  than  one  mounted  on  a  flexible 
base.  The  mathematics  required  to  find  its  coordinates 
would  be  simpler  and  so  would  its  mechanical  complexity.  It 
might  seem  that  a  rigid  mounted  sensor  would  be  the  best. 
But  there  are  some  advantages  to  a  flexibly  mounted  sensor 
that  may  outweigh  its  disadvantages.  One  advantage  of  a 
flexibly  mounted  sensor  is  that  the  manipulator  would  not 
have  to  come  to  a  complete  stop  when  a  point  was  touched. 
The  sensor  could  just  bend  out  of  the  way  and  not  impede  the 
continuous  motion  of  the  manipulator.  This  would  allow 
faster  motion  of  the  manipulator  and  would  reduce  the  risk 
of  damage  to  the  manipulator,  sensor,  or  the  object  to  be 
touched.  Another  advantage  would  be  that  many  sensors  could 
be  used  at  once  if  they  were  all  on  flexible  mounts.  When 
one  sensor  hit  a  surface,  it  could  respond  and  then  bend  out 
of  the  way  to  let  the  next  sensor  touch,  see  Pig.  4«2. 

Flexible-base  touch  sensors  could  be  constructed  with 
or  without  degrees  of  freedom.  The  type  without  degrees  of 
freedom  would  only  work  when  straight,  then  simply  shut  off 
when  bent  over  so  as  not  to  register  any  erroneous  points. 
If  the  sensor  had  one  or  two  degrees  of  freedom,  it  could 
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still  register  points  even  when  bent  over,  see  Fig.  -l .  3 . 
This  way,  a  continuous  stream  of  points  could  be  read  in  one 
motion.  The  trade  off  would  come  when  deciding  whether  it 
is  more  important  to  have  fewer  degrees  of  freedom  or  the 
capability  to  read  many  points  with  one  sensor. 

4.1.3  Where  to  Mount  the  Sensor 

Since  the  sensor  is  to  work  with  a  manipulator,  the 
most  likely  place  to  mount  the  sensor  would  be  on  the 
manipulator  itself.  If  the  sensor  were  mounted  at  the  wrist 
of  the  manipulator,  the  sensor  would  have  six  degrees  of 
freedom  and  be  most  maneuverable.  If  it  were  too  awkward  to 
use  the  wrist,  the  next  best  mount  would  be  the  forearm  of 
the  manipulator.  This  would  reduce  the  number  of 
calculations  required  to  locate  the  sensor  in  space  but 
would  still  leave  three  degrees  of  freedom. 

The  sensor  could  theoreticly  reach  any  point  in  front 
of  the  manipulator  but  the  sensor  would  only  be  able  to 
approach  any  one  point  from  one  direction.  The  sensor  would 
not  be  able  to  reach  around  an  object  in  the  way,  see  Fig. 
4.4.  A  solution  might  be  to  install  many  sensors  on  the  arm 
protruding  in  all  different  directions  so  as  to  be  able  to 
reach  all  points  with  at  least  one  sensor,  see  Fig.  4.5* 

The  very  best  mounting  location  would  be  to  have  the 
sensor  mounted  on  its  own  arm.  This  could  run  completely 
independent  of  the  manipulator  and  be  controlled  by  a 
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Pig.  4.4:  3  Degree  of  Freedom  Manipulator  with  Interference 
Problem 


Pig.  4.5:  Solution  to  Interference  Problem 

Several  mounted  touch  sensors  could  reach  more  areas  and 
would  not  increase  the  degrees  of  freedom  of  the  manipulator 
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different  operator  or  perhaps  be  completely  controlled  by 
computer.  A  computer  could  be  programmed  to  randomly  sweep 
the  sensor  around  and  to  concentrate  on  relatively  untouched 
areas. 

4 . 2  Touch  Sensors  Used  in  Experiments 

The  touch  sensors  that  were  built  for  experiments  were 
designed  solely  to  get  surface  points  into  the  computer  as 
efficiently  as  possible.  The  touch  sensors  were  always 
mounted  firmly  in  the  jaws  of  the  manipulator  and  only 
on-off  electrical  switches  were  used  to  send  signals  to  the 
computer. 

The  first  sensor  built  had  10  switches  on  it  and  each 
was  connected  seperately  to  digital  inputs  on  the  analog  to 
digital  converter,  see  Pig.  4.6.  The  switches  were  mounted 
on  somewhat  flexible  stems  and  were  arranged  like  a  brush. 
It  was  found  that  a  shorter  stem  provided  the  most  accurate 


point 

coordinates  and  a  slight 

convex 

curve 

to  the 

profile 

of  the 

endpoints  of  the  stems 

allowed 

the 

senso  r 

to  be 

rocked 

across  a  surface  to 

collect 

a  maximum  amount  of 

po ints. 

This  brush  sensor  had  some  problems  that  made  it 
difficult  to  use.  The  biggest  problem  was  that  the  switches 
worked  only  when  pressed  from  one  direction.  When  a  switch 
was  hit  from  the  3ide  nothing  would  happen.  This  meant  the 
sensors  al/  -:s  had  to  be  pointed  in  the  direction  the 
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manipulator  was  being  moved  to  make  sure  the  switches  would 
be  hit  straight-on.  Another  problem  was  the  sensors  were 
too  far  from  the  base  of  the  manipulator  wrist.  It  turned 
out  that  the  joint  angles  of  the  wrist  could  net  be 
calculated  accuratly  and  errors  multiplied  the  farther  the 
sensors  were  from  the  base  of  the  wrist. 

The  second  sensor  built  had  only  one  switch  on  it,  see 
Pig.  4.7.  This  was  because  in  later  experiments  it  was 
desirable  to  be  able  to  select  individual  points  on  a 
surface.  Also,  the  second  touch  sensor  was  located  such 
that  one  degree  of  freedom  of  the  wrist  was  not  needed  to 
calculate  the  sensor's  coordinates. 

Although  the  brush  sensor  had  many  more  switches  on  it, 
the  second  sensor  could  collect  points  just  about  as  fast. 
This  was  because  the  second  sensor  was  made  to  be  sensitive 
when  approaching  a  surface  from  any  direction,  see  Fig. 
4.8.  Besides  being  easier  to  maneuver  than  the  brush  sensor 
it  could  also  be  moved  faster  because  the  manipulator  only 
had  Lv,  move  at  the  wrist  to  trigger  the  switch.  The  brush 
sensor  required  that  the  entire  manipulator  be  moved  to  get 
the  switches  to  approach  the  surface  from  the  correct 
direction. 
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CHAPTER  5.  CALCULATION  OF  POINT  COORDINATES 

5 •  1  Description 

The  picture  of  the  manipulator  was  refreshed  about 
every  20  milliseconds  while  the  touch  sensor  program  was 
running.  .To  do  this,  the  new  angles  of  the  manipulator  had 
to  be  read  every  cycle.  The  coordinates  of  a  touch  point 
would  be  calculated  during  the  cycle  also  whenever  a  touch 
sensor  was  activated.  This  was  done  by  computing  the 
sequential  angular  transformations  from  the  base  of  the 
manipulator  to  the  touch  sensor  tip.  Intermediate 
transformations  from  each  manipulator  link  were  saved  so  the 
manipulator  itself  could  be  drawn  on  the  graphic  display. 
The  coordinates  of  touch  points  were  calculated  and  stored 
using  the  manipulator  base  as  a  relative  origin  and  the  x, 
y,  and  z  axes  were  as  shown  in  Fig.  5-1.  Only  integer 

values  could  be  sent  to  the  display  processor  so  length 

units  were  chosen  such  that  there  were  40  units  per  inch. 
These  units  were  chosen  to  minimize  round  off  error  and  at 
the  3ame  time  not  overrun  the  display  processor  maxima" 
length  values,  (plus  or  minus  2048).  The  basis  for  the 

dynamic  display  of  this  manipulator  was  developed  by  C. 

Winey  and  is  explained  in  some  detail  in  Ref.[l]. 

3 . 2  Problems  with  the  Manipulator 

The  manipulator  that  was  used  to  maneuver  the  touch 
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sensor  was  built  to  be  controlled  by  a  human  who  would  have 
direct  visual  feedback  as  to  where  he  was  moving  it.  This 
type  of  control  system  did  not  require  accurate  positioning 
because  it  was  assumed  the  operator  would  compensate  for 
errors.  Consequently  the  manipulator  was  not  very  good  for 
finding  absolute  point  locations.  This  posed  some  unique 
problems  to  getting  accurate  point  angles.  The  problem 
could  be  rectified  by  using  a  more  rigid  manipulator  with 
less  elasticity  and  "free  play". 

5.2.1  Cables  and  Gears 

The  joints  of  the  manipulator  were  connected  to  the 
servos  and  position  transducers  by  a  series  of  cables  and 
gears.  This  allowed  for  much  backlash  and  flexibility  which 
translated  into  errors  for  recorded  joint  angles.  Any  error 
in  joint  angles  in  turn  translated  into  larger  errors  in 
calculated  point  coordinates.  One  way  these  errors  were 
minimized  was  to  make  the  touch  sensor  sensitive  to  very 
light  pressure  to  reduce  the  strain  on  the  cables.  Another 
solution  was  to  minimize  the  effect  joint  angle  errors  had 
on  point  coordinates.  The  wrist  joints  were  most  prone  to 
errors  because  they  were  connected  with  the  longest  cables. 
Their  effect  was  minimized  by  keeping  the  touch  sensor  as 
close  to  the  base  of  the  wrist  as  possible. 
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5.2.2  Pushrod 


The  elbow  joint  of  the  manipulator  was  connected  to  its 
servo  and  transducer  by  the  pushrod  arraingement  shown  in 
Pig.  5.2.  At  first  it  was  thought  that  the  gear  angle  Ag 
would  respond  very  much  the  same  as  the  elbow  angle  Ae  and 
that  they  could  be  considered  as  equivalent.  For  relative 
motions  this  worked  well  enough  but  for  calculating  absolute 
point  locations,  the  long  forearm  length  multiplied  a  small 
angle  error  into  a  large  position  error.  Pig.  5.3a  shows 
the  calculated  locations  of  points  on  a  flat  square  grid 
when  it  was  assumed  that  Ag  and  A3  were  the  same.  Clearly 
this  assumption  is  invalid  for  absolute  positioning. 

An  equation  had  to  be  developed  to  calculate  the  elbow 
joint  angle  A3  from  the  two  angles  it  was  dependent  on,  Ag 
and  the  X  motion  angle  A2.  A  closed  solution  for  A3  would 
be  very  long  because  the  linkage  was  3-dimensional  and 
relatively  complex.  This  was  to  be  avoided  if  the 
calculations  were  to  be  done  in  real-time.  Since  the  angle 
A3  was  to  be  calculated  for  small  incremental  changes  on 
each  cycle  it  was  decided  to  use  the  previous  value  of  A3  on 
some  preliminary  calculations  when  figuring  the  new  A3- 
Guessing  the  new  value  of  A3  could  eliminate  some  long 
calculations  that  really  did  not  have  much  effect  on  the 
final  answer.  The  method  used  was  to  calculate  the  x,  y, 
and  z  locations  at  each  end  of  the  pushrod  using  Eq.  5-1. 
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(Xg,  Yg, 


2g) 


A2 

(in  X, Y  plane) 


Fig.  5-2  Nonlinear  Pushrod 
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(  5.1  ) 

a  )  Xg  =3.10 

b  )  Yg  =-4.5  si n(  Ag  ) 

c  )  Zg  =4-5  co s (  Ag  ) 

d  )  X3  =  2.25  cos(  A2  )  -  4.5  sin(  A2  )  cos(  A3  ) 

e  )  Y3  =  18.  +  4.5  sin(  A3  ) 

f  )  Z3  =  2.25  sin(  A2  )  +  4-5  cos(  A2  )  cos(  A3  ) 

The  pushrod  length  was  known  to  be  18.02  inches  and  could 
also  be  defined  in  Eq.  5.2. 

(  5.2  )  18.02  =  ~\J (X3  -  Xgf  +  (Y3  -  Yg f  +  (Z3  -  Zg f 

Between  Equations  5-1  and  5.2  there  are  7  equations  and 
9  variables.  The  two  variables  A2  and  Ag  are  known  so  all 
the  others  should  be  defined  if  the  equations  are  all 
linearly  independent.  The  problem  is  that  A3  appears  3 
times,  once  in  a  sine  function  in  Eq.  5.1 e  and  twice  in  a 
cosine  funtion  in  Eqs.  5.  Id  and  5* If.  This  makes  the 
problem  of  calculating  A3  very  nonlinear  and  makes  it  useful 
to  do  some  guessing.  If  it  is  assumed  that  A3  is  usually 
near  zero,  then  small  errors  in  A3  will  have  little  effect 
on  cos(A3).  That  means  it  should  not  make  much  difference 
if  the  value  of  A3  from  the  previous  cycle  is  used  to 


calculate 


then  it  is 
value  of 
to : 


cos(A3)  in  Eqs.  5*  Id  and  5- If*  If  this  is  done 
a  straight  foward  problem  to  calculate  the  new 
A3  from  Eq.  5*1 e.  Equation  5*2  can  be  converted 


CHAPTER  6. 


? 3LYHESRA  COHSTRUCTIQi: 

6 . 1  Introduction 

The  previous  chapter  described  a  method  of  finding 
3-dimensional  point  locations  on  a  surface.  It  became 
apparent  later  that  it  would  be  very  useful  to  have  a  way  of 
describing  the  surface  the  points  where  found  on.  To  have  a 
geometric  description  of  the  surface  would  make  it  feasible 
to  delete  hidden  lines  and  surfaces  because  a  definite  edge 
would  be  defined.  It  would  also  provide  a  basis  for 
deciding  inside  from  outside  and  make  it  possible  to 
calculate  volume  and  surface  area. 

First,  simply  connecting  each  point  to  its  three 
nearest  neighbors  on  the  graphic  display  was  tried.  This 
had  disappointing  results  because  the  lines  tended  to 
cluster  in  small  bunches  and  didn't  interconnect  very  much. 
The  approach  was  discarded  because  it  didn't  give  any 
semblance  of  a  closed  object  and  was  no  better  than  bare 
dots  for  making  a  recognizable  picture. 

It  is  a  trivial  problem  for  human  to  connect  a  given 
set  of  points  with  lines  to  make  a  closed  shape  so  it  would 
seem  that  a  solution  solvable  by  a  computer  would  be 
possible.  The  problem  is  a  human  can  make  a  judgement  based 
on  the  whole  set  ?f  points  at  once  while  a  computer  can  only 
operate  on  a  very  small  portion  at  a  time.  This  means  an 
iterative  process  must  be  found  to  construct  the  surface 
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with  the  aid  of  a  computer. 

It  was  decided  to  treat  the  surface  as  a  geometric 
polyhedron  (this  is  what  the  surface  would  come  out  as 
anyway  if  the  surface  is  cor.stucted  properly)  .  Also,  a 
constraint  was  imposed  that  the  polyhedron  surface  be  made 
up  entirely  of  triangular  facets.  This  was  done  because  it 
provides  the  computer  the  simplest  possible  surface  segments 
to  process.  Also,  triangular  facets  give  the  greatest 
resolution  for  a  given  number  of  points.  A  four  sided  facet 
connecting  four  dots  would  be  the  same  as  two  triangular 
facets  without  the  cross  line. 

6.2  2-Jimensional  Solution 

The  2-dimensional  solution  to  the  problem  will  be  shown 
first  because  it  has  many  analogies  to  the  3-dimensional 
solution  but  is  much  easier  to  explain.  In  this  case  there 
are  points  scattered  randomly  on  the  edges  of  a  flat  area  in 
two-space.  The  problem  consists  of  finding  the  best  way  of 
connecting  the  points  to  enclose  the  area  and  describe  its 
edge,  see  Pig.  6.1. 

The  problem  is  fairly  trivial  if  the  area  in  question 
is  completely  convex.  The  correct  way  to  connect  any 
combination  of  edge  points  will  always  come  out  a  convex 
polygon  and  any  wrong  solution  will  have  some  lines  that 
cross  over  one  another.  This  suggests  an  algorithm  where  a 
computer  could  try  every  possible  line  connection 
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combination  until  it  came  across  a  solution  where  there  were 
no  crossing  lines.  The  trouble  is  that  the  number  of 
required  trials  would  go  up  exponentially  with  the  number  of 
points  to  connect. 

The  solution  to  this  problem  that  is  most  similar  to 
the  one  used  to  solve  the  3-D  problem  is  an  iterative 
approach.  First,  any  3  points  are  connected  with  lines  to 
form  a  triangle.  Now  if  the  area  is  still  convex  then  all 


the  other  points  lie 

outside 

this  triangle. 

It  is  important 

at  this 

stage  to 

define  inside 

from 

outside  for  each 

line  be 

cause  the 

computer 

will 

only 

consider  one  line  at 

a  time. 

It  can  be 

seen  from 

Fig. 

6.2 

that  the  three  lines  of  the  triangle  can  be  defined  as  1-2, 
2-3,  and  3-1  assuming  that  the  x-y  locations  of  points  1,  2, 
and  3  are  known.  The  line  1-2  can  be  thought  of  as  a  vector 
with  base  1  and  end  2.  Now  the  outer  side  this  vector  can 
be  defined  arbitrarily  as  its  right  side. 

After  the  initial  triangle  is  made  and  inside  and 
outside  defined,  it  is  a  straightf oward  problem  to  add  each 
point  onto  the  existing  polygon.  An  example  is  shown  in 
Fig.  6.2.  Point  4  is  to  be  added  to  polygon  1-2,  2-3,  3-1  • 
It  is  apparent  that  line  1-2  is  the  only  one  that  faces  out 
toward  point  4,  (there  will  always  be  just  one  such  line  if 
the  area  is  convex).  Now  the  line  1-2  can  be  deleted  and 
the  lines  1-4  and  4-2  added  to  make  a  new  polygon  1-4,  4-2, 
2-3,  3-1  •  The  only  decisive  task  for  the  computer  is  to 
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Pig. 


6.1:  Connecting  2-D  Surface  Points  into  Polygon 


sequence  specifies  point  connection 
and  outer  side  of  each  line 


Pig.  6.2:  Definition  of  Lines  and  Polygons 


find  the  line  which  is  best  to  attach  the  point. 


The  problem  becomes  more  complex  if  areas  with  concave 
edges  are  allowed.  Many  different  polygons  can  be  made  from 
a  given  set  of  points  if  there  are  concave  edges,  see  Pig. 
6.3.  What  can  be  done  to  limit  the  number  of  possible 
polygons  to  one? 

If  it  can  be  assumed  that  touch  sensors  were  used  to 
find  the  points,  then  data  about  the  direction  from  which 
the  point  was  approached  will  be  available.  A  "touch 
vector"  can  be  associated  with  each  point  to  indicate  its 
outer  side,  see  Pig.  6.4.  Note  that  the  touch  vector  does 
not  necessarily  have  to  be  at  right  angles  to  the  edge 
touched.  It  is  only  che  centerline  of  the  touch  sensor  at 
the  instant  the  point  is  touched.  Now  a  single  polygon 
solution  is  again  possible  if  the  constraint  is  imposed  that 
the  touch  vectors  cannot  pass  through  the  polygon,  see  Pig. 
6.5 •  Also,  for  computer  control,  there  will  only  be  one 
line  on  the  polygon  available  to  attach  a  new  point  to,  (if 
any).  If  the  new  point  is  found  to  be  inside  the  existing 
polygon  then  the  correct  line  to  attach  it  to  is  the  one  the 
touch  vector  passes  through. 

Some  problems  can  occur  with  convex  polygons.  It  is 
possible  to  come  across  a  point  that  has  no  line  on  the 
polygon  that  it  can  attach  to  without  violating  a  rule,  see 
Pig.  6.6a.  In  these  situations,  the  point  must  be  thrown 
out  or  set  aside  until  the  polygon  is  developed  enough  to 
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right  solution 


Pig.  6.3:  Concave  Polygons 

In  general,  there  are  many  ways  to  coi 
concave  area  and  still  get  a  closed  p< 


Pig.  6.4:  Definition  of  Touch  Vector! 


I 


touch  vectors 
away  from 


must  always  point 
the  polygon 


Fig.  6.5:  Constructing  Concave  Polygons  with  Touch  Vectors 

There  will  only  be  one  polygon  solution  if  touch  vectors  are 
considered. 
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accept  the  point.  Another  problem  with  convex  areas  is  that 
|  a  folded  polygon  can  be  constructed  by  the  computer,  see 

,  Pig*  6.6b.  The  solution  to  this  problem  is  to  ignore  any 

^  point  that  has  a  touch  vector  that  goes  through  any  line  on 

the  polyhedron  from  its  outer  side. 

It  is  also  possible  to  attach  a  new  point  to  a 
completely  erroneous  line  if  a  finite  length  touch  sensor  is 
used  on  an  extremely  convoluted  polygon,  see  Fig.  6.7. 
This  problem  could  be  solved  by  putting  a  bend  in  the  touch 
vector  to  more  accurately  simulate  the  touch  sensor  and  its 
arm.  An  easier  solution  is  to  ignore  points  found  to  be 
over  a  certain  depth  inside  the  polygon. 

6.3  3-Dimensional  Solution 

The  problem  here  is  to  find  a  way  to  connect  3-D 
surface  points  with  lines  to  make  a  polyhedron  that  closely 
resembles  the  surface  the  on  which  points  were  found.  It 
turned  out  that  the  best  way  to  solve  the  problem  was  not  by 
analyzing  the  connecting  lines  but  by  analyzing  the  facets 
of  the  polyhedron.  If  the  facets  on  a  set  of  points  is 
known  then  the  edges  are  also  known.  Triangular  facets  were 
used  as  stated  earlier. 

6.3*1  Polyhedron  Description 

A  method  is  required  to  store  the  facets  in  computer 
memory.  It  was  decided  to  describe  the  facets  as  a  sequence 
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-45- 


a.  Point  6  cannot  be  attached  to  the  existing  polygon  without 
causing  a  touch  vector  to  pierce  through.  It  is  not  likely 
that  point  6  is  even  from  the  same  area  as  points  1  -  5* 


2 


b.  Point  6  cannot  be  attached  to  the  polygon  without  turnin 
it  inside-out.  Point  6  will  have  to  be  ignored  or  saved  unt 
the  polygon  is  further  developed. 


Pig.  6.6:  Examples  of  Points  That  Cannot  be  Attached 


Pig.  6.7:  Example  of  an  Incorrectly  Attached  Point. 

To  keep  the  touch  vector  on  the  outside  of  the  polyhedron, 
the  touch  point  will  have  to  attach  to  the  wrong  line.  This 
problem  stems  from  the  fact  that  touch  vectors  are  considered 
to  be  infinitly  long  while  the  actual  touch  sensor  is  very 
short.  The  simplest  solution  to  this  problem  is  to  ignore  or 
save  points  that  are  found  to  be  deeper  in  into  the  polyhedron 
than  the  length  of  the  touch  sensor. 
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of  points,  because  the  points  and  their  coordinates  would  be 
already  known.  The  facet  1-2-3  would  be  a  facet  with  edges 
connecting  the  points  1  to  2,  2  to  3,  and  3  to  1  .  Also  the 
inside  and  outside  of  the  facet  could  be  defined  with  this 
number  sequence  using  the  right-hand-rule,  see  Fig.  6.8. 
It  can  be  seen  that  the  facets  1-2-3,  3-1-2,  and  2-3-1  all 
describe  the  same  facet  because  the  sequence  always  goes  in 
the  same  direction  around  the  triangle.  The  facets  3-2-1 , 
2-1-3,  and  1-3-2  describe  the  same  facet  as  above  but  with 
the  opposite  outside  surface. 

The  computer  description  of  a  tetrahedron  is  shown  in 
Fig.  6.9.  Note  that  each  line  on  a  polyhedron  is  given 
twice  in  the  facet  data,  once  on  two  different  facets  and 
always  in  opposite  sequence.  It  might  seem  easier  to 
describe  the  polyhedron  by  storing  the  lines  as  two-number 
sequences  rather  than  the  apparently  redundant  method  of 
storing  facets  as  three-number  sequences.  But  it  turns  out 
to  be  very  important  to  know  the  complete  facets  and  this 
data  would  not  be  readily  available  with  line  information. 

Like  the  2-D  solution,  restraints  were  imposed  that 
restricted  the  configuration  of  the  polyhedron.  No  surfaces 
were  allowed  to  stick  through  one  another  and  no  touch 
vector  could  be  allowed  to  exist  on  the  inside  of  the 
polyhedron.  Also,  like  the  2-D  solution,  an  iterative 
approach  was  used  where  each  point  was  added  onto  an 
existing  polyhedron  one  at  a  time. 
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Fig.  6.8:  3-D  Definition  of  Facets 

Number  sequence  defines  point  connection  and  outer 
side  of  facet  using  the  right-hand- rule. 


Fig.  6.9:  Example  of  Complete  3-D  Polyhedron 


How  can  a  new  point  be  added  onto  a  polyhedron?  First, 


it  is  helpfull  to  exploit  some  of  the  useful  properties  of 
polyhedrons  as  described  by  Euler's  formula  for  polyhedrons, 
where  F  is  the  number  of  faces  on  a  polyhedron,  E  is  the 
number  of  edges  or  connecting  lines,  and  V  is  the  number  of 
vertices  or  points. 

(  6.1  )  F  =  E  -  V  +  2 

This  equation  holds  for  any  ordinary  3-D  polyhedron  that 

does  not  have  any  holes  passing  through  it. 

Only  polyhedrons  with  triangular  facets  will  be 
considered  so  another  defining  equation  is  given.  On  a 
polyhedron  with  triangular  facets  it  can  be  seen  that  each 
facet  has  exactly  3  edges  and  that  each  edge  separates 
exactly  two  facets.  Thus: 

(  6.2  )  3F  =  25  (for  triangle  faceted  polyhedrons) 

Combining  Eqs.  6.1  and  6.2  gives  two  relations. 

(  6.3  )  F  =  2V  -  4 

(  6.4  )  E  =  3V  -  6 

Equations  6.3  and  6.4  show  that  for  each  new  point 

added  to  a  triangular  polyhedron  there  will  have  to  be  2 
more  facets  and  3  more  lines. 

For  the  2-D  solution  a  point  was  added  onto  the 

existing  polygon  by  deleting  one  chosen  line  and  adding  2 

more.  In  effect,  the  point  was  attached  to  the  place  were 

one  line  used  to  be.  In  the  3-D  solution  a  facet  must  be 

chosen  on  the  existing  polyhedron  on  which  attach  the  new 

-50- 


point.  That  facet  is  then  deleted  and  the  resulting  hole  is 
closed  by  adding  3  new  adjacent  facets  that  reached  out  to 
the  new  point,  see  Fig.  6.10.  This  procedure  satisfies 
Equation  6.3,  in  the  total  number  of  facets  added  to  the 
polyhedron  for  each  new  point.  It  is  also  apparent  from 
Fig.  6.10  that  Equation  6.4  is  satisfied  because  exactly  3 
new  lines  are  added. 

One  of  biggest  problems  was  deciding  which  facet  to 
attach  the  point  to.  Unlike  the  2-D  problem  there  was  not 
always  a  single  answer,  even  when  touch  vectors  were 
considered.  In  general  there  could  be  several  facets  that  a 
point  could  be  attached  to  that  would  produce  a  closed 
polyhedron  and  would  not  cause  any  touch  vectors  to  stick 
through  any  surface.  More  restraints  had  to  be  incorporated 
to  make  the  computer  converge  on  a  single  facet. 

One  restraint  added  to  the  program  was  that  if  a  facet 
was  pierced  from  the  negative  side  of  the  touch  vector  of  a 
new  point,  then  that  point  must  attach  to  that  facet, 
assuming  all  the  other  restraints  are  satisfied.  This 
restraint  worked  very  well  in  situations  where  the  new  point 
was  close  to  the  polyhedron  and  the  touch  vector  most  likely 
passed  through  the  best  facet. 

Sometimes,  though,  the  new  point  was  so  far  away  that 
its  touch  vector  did  not  pass  through  the  polyhedron  at  all 
and  if  it  did,  the  facet  it  pierced  through  was  not  likely 
to  be  the  best.  To  cover  these  situations  a  secondary 
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restraint  was  added  which  required  that  the  :.~w  point  attach 
to  the  facet  with  the  nearest  centroid. 

If  the  new  point  was  very  far  away  from  the  polyhedron, 
there  would  be  very  little  chance  the  new  point  would  attach 
to  a  good  facet,  see  Fig.  6.11.  The  solution  to  this 
problem  was  to  ignore  points  over  a  specified  distance  away. 
Taken  together,  these  restraints  caused  the  computer  to 
converge  on  a  single  facet  and  usually  it  was  the  best  one. 
Sven  when  the  chosen  facet  did  not  look  like  the  best,  the 
next  step  of  processing  usually  converged  on  a  better 
solution  for  the  polyhedron. 

Many  times  the  new  point  was  found  to  be  on  the  inside 
of  the  polyhedron.  In  these  cases  there  was  at  least  one 
facet  that  could  be  found  which  the  point's  touch  vector 
pierced  from  the  inside.  This  was  the  only  facet  the 
interior  point  could  attach  to  and  keep  its  touch  vector  on 
the  outside  of  the  polyhedron,  see  Fig.  6.12. 

6.3.2  Initializing  the  Polyhedron 

The  above  procedure  worked  only  at  adding  points  to  an 
existing  polyhedron.  A  seperate  algorithim  was  required  to 
create  a  starting  polyhedron  from  a  set  of  initially 
unconnected  points.  The  method  used  only  required  3  points 
to  make  an  imaginary  two  sided  polyhedron.  The  computer  was 
simply  instructed  that  there  were  two  facets,  one  on  each 
3ide  of  the  triangle  defined  by  the  3  new  point3,  see  Fig. 
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Fig.6.11:  Possible  Errors  from  Attachment  of  Distant  Points. 

In  general,  it  is  very  difficult  to  make  a  rational  decision 
on  which  facet  to  attach  a  distant  point  to.  The  choice, 
though,  can  have  a  drastic  effect  on  the  resulting  shape 
of  the  polyhedron.  The  easiest  solution  to  this  problem  is 
to  ignore  points  that  are  over  a  certain  distance  from  the 
po  lyhedron. 


touch  vector 


Pig.  6.12:  Attachement  of  Interior  Points 

Interior  points  must  always  attach  to  the  facet  that  the  touch 
vector  pierces  through. 


1 


initialization  facets 
1-2-3 
3-2-1 


Pig.  6.13:  Initialization  of  Polyhedron 

First  3  points  are  connected  with  2  facets  to  make 
psuedo-closed  polyhedron. 
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6.13.  The  computer  had  no  capacity  to  reject  such  an 
impossible  polyhedron  once  it  had  been  installed.  Any  3 
noncolinear  points  in  space  can  be  connected  this  way  and 
will  not  technically  violate  any  of  the  stated  polyhedron 
rules.  This  entity  also  satisfied  Equations  6.3  ana  6.4 
which  specify  the  correct  number  of  verticies,  edges,  and 
faces  for  a  real  polyhedron. 

When  the  4th  point  is  added  on,  the  computer  will  use 
the  usual  algorithm  to  erase  one  of  the  coplaner  facets  and 
add  3  more  to  make  a  tetrahedron.  The  reason  that  a 
tetrahedron  was  not  used  tor  initialization  is  that  too  much 
programing  space  would  be  required  make  sure  the  shape  was 
not  inside  out  and  also  that  none  of  the  touch  vectors  where 
piercing  through. 

6.3-3  Checking  Facet  Pairs 

After  a  new  point  had  been  attached  to  the  polyhedron, 
the  facets  were  not  usually  in  the  best  configuration.  The 
new  point  could  be  sitting  on  the  top  of  a  long  spike  or 
otherwise  looking  as  though  it  was  3tuck  on  as  an 
afterthought,  see  Fig.  6.14. 

Since  there  were  usually  many  possible  polyhedron 
configurations  that  a  given  set  of  points  could  be  built 
into,  some  new  critera  had  to  be  used  to  make  sure  that  one 
polyhedron  solution  was  decided  upon. 


The  method  chosen  to  modify  the  polyhedron  was  to  check 


adjacent  pairs  of  facets  and,  if  required,  replace  then  with 
compliment  facets.  Figure  6.15  shows  how  the  four  corner 
points  connected  by  any  two  adjacent  triangles  could  also  be 
the  corner  points  of  two  other  completely  different 
triangles.  The  facets  8-6-5  and  5-6-7  are  the  starting 
facets  and  8-6-7  and  8-7-5  are  the  compliment  '  facets.  An 
entire  polyhedron  could  be  modified  bit  by  bit  by  changing 
facet  pairs  and  the  polyhedron  would  never  have  to  be 
considered  as  a  whole. 

The  primary  criterion  used  for  deciding  if  a  pair  of 
facets  should  changed  was  based  on  the  idea  that  a 
polyhedron  with  the  smoothest  surface  will  be  the  best.  In 
other  words  a  polyhedron  would  be  seached  for  that  had  a 
minimum  average  angle  between  facets.  This  was  done  by 
comparing  the  pair  of  facets,  considered  for  changing,  to 
their  four  neighboring  facets.  The  algorithm  checked  the 
angular  difference  between: 

1 )  the  original  facets. 

2)  the  compliment  facets. 

3)  the  neighboring  facets  and  the  pair  to  be  checked. 

4)  the  neighboring  facets  with  the  compliment  facets. 

This  gave  5  angular  differences  to  average  for  each  of  two 
polyhedron  surfaces.  If  the  complimentary  facet  arrangement 
was  found  to  have  les3  average  angular  difference,  then  the 
facets  would  be  changed. 

oeveral  checks  had  to  be  performed  when  it  was  decided 
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to  change  a  pair  of  facets.  '.lew  facets  could  not  be  allowed 
to  stick  through  another  surface  of  the  polyhedron.  Also,  a 
check  had  to  be  made  that  none  of  the  touch  vectors  of  the 
points  on  the  polyhedron  pierced  through  the  new  facets. 
The  change  in  facets  would  be  stopped  if  any  of  the  above 
happened. 

It  was  possible  to  come  across  a  pair  of  facets  that 
had  no  reasonable  compliment.  These  facet  pairs  were  not 
considered  changable  and  were  found  by  checking  to  see  if 
any  of  the  compliment  cross-lines  were  already  occupied  by 
other  facets. 

It  would  not  be  expected  to  find  a  touch  vector  that 
lay  at  an  angle  of  greater  than  90  degrees  to  the  surface 
normal  of  an  adjacent  polyhedron  facet.  The  computer, 
though,  would  construe"  a  polyhedron  this  way  if  not 
instructed  to  consider  touch  vector  angles.  Therefore, 
another  restraint  was  added  that  any  facet  pair  had  to  be 
made  convex  if  it  had  a  corner  point  with  a  touch  vector 
that  pointed  away  from  its  surface  normal  at  greater  than  90 
degrees. 

The  above  requirements  had  to  have  certain  priorities 
because  they  very  often  conflicted  with  one  another.  The 
order  of  priority  was: 

1 )  The  polyhedron  must  remain  a  closed  object  and 
cannot  be  allowed  to  fold  on  itself  or  wrap  inside  out. 
Also  all  touch  vectors  must  exist  on  the  outside  of  the 
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polyhedron  and  cannot  be  allowed  to  stick  through. 

2)  Any  facet  pair  with  a  touch  vector  that  pointed 
away  at  greater  than  90  degrees  from  its  surface  normal  had 
to  be  convex. 

3)  The  facet  pair  that  had  the  least  average 
difference  between  themselves  and  their  four  neighbors  had 
to  be  chosen. 

When  one  pair  of  facets  were  converted,  it  affected  all 
the  neighboring  facets  as  to  whether  they  still  followed  the 
above  requirements.  This  meant  all  these  facets  had  to  be 
rechecked. 

The  routine  used  to  decide  which  facets  to  check  was 
fairly  simple.  First  all  the  facets  were  checked  around  the 
spot  where  a  new  touch  point  was  added  to  the  polyhedron. 
Then,  if  one  of  these  facets  was  converted,  all  its 
neighboring  facets  were  put  in  a  list  of  facets  to  be 
checked.  The  routine  stopped  when  the  list  was  empty. 
Sometimes  a  pair  of  facets  to  be  changed  could  get  skipped 
over  because  the  list  was  limited  to  30  points.  These 
facets  would  be  found  by  using  an  operator  controlled  option 
that  checked  every  facet  pair  on  the  polyhedron  to  catch  any 
that  were  incorrect. 

There  was  some  concern  that  a  polyhedron  might  be 
formed  that  would  have  a  chain  of  mutually  dependent  facet 
pair3.  In  other  words  each  facet  change  would  cause  the 
neighboring  facets  to  change  and  an  endless  loop  of  changing 
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facets  wo ul  1  be  formed.  The  existence  of  such  a  polyhedron 
has  not  been  prrver.  but  if  was  never  observed  to  occur.  The 
computer  program  would  always  converge  on  a  polyhedron  where 
all  the  facet  pairs  satisfied  the  requirements. 

6.3.4  duality  of  the  Polyhedron  Shapes 

It  might  seem  that  there  would  always  be  one  solution 
that  the  computer  would  converge  upon.  This  was  not  always 
true.  Sometimes  the  polyhedron  would  get  into  a  bad  shape 
the  computer  algorithm  could  not  get  it  out  of.  This  due  tc 
the  fact  that  the  computer  a_Lgcrithim  based  its  decisions  on 
only  one  pair  of  facets  at  a  time.  There  was  no  way  for  the 
computer  to  get  to  better  facet  configuration  if  the  first 
facet  change  meant  putting  the  polyhedron  in  an  impossible 
shape. 

The  method  used  to  keep  the  polyhedron  from  locking 
into  bad  shapes  was  to  make  sure  that  new  points  were  not 
added  an  unreasonable  distance  away  from  the  existing 
polyhedron.  If  the  maximum  distance  was  held  to  within  the 
general  feature  dimensions  of  the  object  being  touched  then 
the  points  would  attach  onto  reasonable  areas.  It  would  be 
very  difficult  to  attach  a  new  point  to  a  developed 
polyhedron  in  the  right  place  if  the  polyhedron  was  roughly 
one  foot  across  and  the  new  point  was  more  than  two  feet 
away,  see  Pig.  6.12. 


-62- 


M ETHODS  OF  DISPLAY 


CHAPTER  7. 


7 . 1  Introduct ion 

The  3-dimensional  information  needed  to  completely 
describe  points  and  polyhedrons  in  space  can  be  easily 


stored  as  data 

in  a 

computer.  But 

if  these  data 

are  just 

displayed  as 

lists 

of  numbers, 

it 

will  be 

absolutely 

meaningless  to 

a 

human.  A  graphic 

d  i  s  pi  ay 

can  show 

3-dimensional 

data 

much  better 

but 

suffers  from  the  fact 

that  it  can  only  display  a  2-dimensional  picture.  This 
chapter  will  consider  different  methods  of  bringing  out 
3-dimensionality  for  data  to  be  shown  on  a  graphic  display. 

7.2  Problems  with  Polyhedra  Displays 

Host  of  the  methods  used  to  display  3-dimensionality 
described  here  were  developed  long  before  it  was  possible  to 
create  polyhedra  from  point  data.  It  would  have  been  very 
difficult  to  understand  what  was  happening  in  the  program 
without  it.  This  was  because  it  was  impossible  to  tell  what 
the  computer  was  constructing  in  3-D,  without  a  good  method 
of  viewing  it.  A  polyhedron  drawn  on  a  vector  graphic 
display  just  looked  like  a  mass  of  connected  lines  if  hidden 
segments  were  not  removed.  There  was  no  way  to  tell  if  one 
triangle  was  sticking  though  another  triangle  in  3-space 
when  only  one  flat  view  was  available,  see  Pig.  7.1. 

There  are  several  ways  to  improve  the  depth  of  a  flat 
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picture.  Showing  perspective  is  one  way  but  it  is  best 
suited  to  rectangular  .  shapes.  Triangles  shown  in 
perspective  just  look  like  slightly  different  triangles. 
Deleting  hidden  lines  and  providing  shading  are  methods  that 
bring  out  depth  for  a  human  but  can  be  very  slow  to  process 
in  real  time.  A  method  using  raster  graphics  to  remove 
hidden  surfaces  will  be  shown  later  in  this  chapter  but  was 
only  good  at  getting  a  static  picture.  C.  Winey  [  1  ]  did 
studies  on  showing  two  orthogonal  pictures  on  the  screen  at 
once  and  displaying  a  shadow  to  help  define 
3-dimensionality.  These  methods  worked  well  for  displays 
where  related  features  could  be  distinguished  in  each  view 
and  were  used  successfully  for  maneuvering  the  touch  sensor 
on  the  screen.  It  was  difficult,  though,  to  distinguish 
related  points  on  a  complex  polyhedron  shown  in  dual  views. 

7.3.1  Rotating  the  Picture 

It  was  found  that  rotating  the  polyhedron  on  the  screen 
helped  to  bring  out  its  3-diraensionality .  Features  in  the 
back  of  the  picture  moved  one  way  and  features  in  front  of 
the  picture  moved  the  other  way.  Specific  details  could  be 
seen  also  if  the  picture  was  rotated  a  full  360  degrees. 
For  example,  it  could  be  seen  whether  or  not  a  line  was 
piercing  a  triangle  if  the  picture  was  turned  completely 
around.  If  a  line  was  not  piercing  a  facet,  then  there  has 
.  to  be  at  least  one  dace  in  the  rotations  on  the  screen 
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where  the  line  does  not  lay  across  the  facet. 

To  give  the  appearance  of  a  rotating  picture, 
object  coordinates  were  calculated  for  a  small  incremental 
angle  change  and  the  picture  was  redrawn  on  the  display.  It 
was  possible  to  redraw  the  picture  rapidly  enough  to  give 
the  illusion  of  smooth  rotation.  The  object  could  be  viewed 
from  any  angle  if  it  was  first  rotated  about  an  axis.  This 
could  be  done  by  multiplying  the  X,  Y,  and  Z  coordinates  of 
the  object  by  a  rotation  matrix  [  T  ]  to  get  the  new 
coordinates  X',  Y' ,  and  Z'. 

(  7.1  )  [  X',  Y\  Z\  1  ]  =  [  X,  Y,  Z,  1  ][  I  ] 

where : 


(  7.2 


[  T  ] 


1  0  0  0~ 

0  cos(A)  -sin(A)  0 
0  sin(A)  cos(A)  0 

0  0  0  1 


(  for  rotation  around  the  x  axis  ) 


(  7.3  ) 


(  7.4  ) 


r  m 


]  = 


cos(  A)  0  sin(  A)  O' 

0  10  0 
-sin(A)  0  cos(A)  0 

0  0  0  1 


(  for  rotation  around  the  y  axis  ) 


[  T  ]  = 


cos(A)  -sin(A)  0  O' 
sin(A)  cos(A  0  0 

0  0  10 

0  0  0  1 


(  for  rotation  around  the  z  axis  ) 


The  orientations  of  the  display  coordinates  and 

object  coordinates  used  for  the  above  equations  are  shown 
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Fig.  7*2a.  A  positive  rotation  is  defined  as  counter¬ 
clockwise  when  looking  down  that  rotation  axis. 

Since  the  display  consisted  of  points  in  space  either 
connected  or  disconnected,  all  that  was  required  to  be 
transformed  was  the  coordinates  of  the  points.  The 
"connectivity"  would  not  change  no  matter  what  the  angle  of 
view. 


A  combination  of  rotations  could  be  made  by  multiplying 
the  rotation  matrices  together.  The  equation; 

(  7.5  )  [  T  ]  =  [  Tz  ][  Ty  ][  Tx  ] 

is  equivalent  to  a  rotation  around  the  z  axis,  then  around 
the  y  axis,  and  then  around  the  x  axis.  It  is  important  to 
keep  the  order  of  multiplication  straight  or  different  views 
will  result. 

It  is  convenient  to  describe  all  the  terms  of  the 
transformation  matix  as  shown  in  Equation  7.6. 


(  7.6  ) 


'XX 

YX 

ZX 

O' 

XY 

YY 

ZY 

0 

XZ 

YZ 

ZZ 

0 

XT 

YT 

ZT 

1 

The  terms  XX  thru  ZZ  handle  rotations  and  their  values 
are  usually  determined  by  equations  7.2,  7.3,  and  7*4.  TX, 
TY,  and  TZ  are  translational  values  that  define  the  position 
of  the  object  relative  to  its  own  coordinate  system.  These 
are  important  if  it  is  desired  to  zoom  in  on  a  small  section 
of  the  object.  A  zoom  effect  is  possible  by  multipling  all 
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terns  of  the  transformation  matrix  by  a  size  factor. 

The  Megatek  Display  Processor  had  the  capability  to  do 
rotations  in  hardware.  The  3  coordinates  of  all  the  points 
defining  the  features  of  the  object  were  first  stored  in 
Megatek  memory.  Then  it  was  given  the  required  rotation 
terms  and  the  Megatek  would  ~ake  care  of  calculating  the 
t ransformations  for  each  poi  it.  This  saved  having  to  do  the 
calculations  for  each  point  in  software  and  also  reduced  the 
amount  of  data  that  had  to  be  sent  to  the  Megatek.  Very 
fast  and  smooth  rotations  were  possible  regardless  of  the 
complexity  of  the  display.  The  transformation  terms 
required  by  the  Megatek  were  XX,  XY,  XZ ,  XT,  YX,  YY,  YZ,  and 
YT.  The  rest  of  the  terms  only  affect  the  z  plane  of  the 
display  which  cannot  be  seen  on  a  2-D  screen. 

The  Megatek  rotations  always  occured  around  the  origin 
of  the  object  as  it  was  installed  in  display  memory.  This 
was  inconvenient  because  very  often  a  small  portion  of  the 
display  would  be  zoomed  in  on  and  would  also  need  to  be 
rotated.  With  the  object  rotating  about  its  center  the 
small  portion  would  generally  rotate  right  out  of  view.  The 
cure  for  this  was  to  cause  the  object  to  always  rotate 
around  in  screen  origin.  The  XT  and  YT  terms  sent  to  the 
Megatek  affected  the  x-y  positions  of  points  in  screen 
coordinates.  These  terms  could  be  altered  each  time  the 
picture  was  rotated  to  keep  the  object  on  screen  center.  To 
do  this,  tiie  translations  in  object  coordinates  had  to  be 
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specified,  (Xo,  Yo,  Zo).  This  was  done  by  manuvering  the 
desired  rotational  base  to  the  center  of  the  screen  by 
viewing  two  orthogonal  views.  Now  the  picture  would  always 
rotate  about  that  base  if  XT  and  YT  were  recalculated  every 
iteration  by  the  equations; 

(  7.7  )  XT  =  XoXX  +  YoXY  +  SoXZ 

(  7.8  )  YT  =  XoYX  +  YoYY  +  ZoYZ 

XX,  XY,  XZ,  YX,  YY,  and  YZ  had  to  be  calculated  first  for 

that  rotation. 

There  is  a  problem  with  dynamic  pictures  that  are 
rotated  with  the  above  transformations.  There  will  be  no 
indication  which  is  front  and  which  is  back  on  an  object 
when  no  hidden  lines  are  removed  and  no  perspective  is 
shown.  An  object  can  be  rotating  on  the  screen  and  some 

people  viewing  it  will  say  its  rotating  to  the  left  while 

others  say  it3  rotating  to  the  right.  The  mind  tends  to 
lock  on  one  rotation  and  can  be  difficult  to  change.  One 
way  found  to  remedy  the  problem  was  to  memorize  the  correct 
rotation  for  each  input  but  it  was  too  easy  to  forget.  The 
most  useful  method  was  to  have  a  known  zero  position  the  the 
picture  could  be  put  in,  where  front  and  back  were  known. 
Another  solution  might  be  to  have  a  coordinate  indicator  on 
the  screen  consisting  of  writing.  Front  and  back  are  easily 
distinguished  with  writing  because  it  cannot  be  read  when  it 
is  shown  reversed. 
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7.3.2  Types  of  Rotation 


Sone  methods  of  rotating  the  picture  were  better  than 
others  at  showing  depth  qualities.  If  the  picture  was 
rotated  about  the  z  axis  of  the  screen,  there  would  be  no 
changes  made  to  the  picture  due  to  its  depth.  The  sane 
rotation  could  be  done  with  a  flat  picture.  Rotation  on  the 
x  axis  or  y  axis  were  better  because  points  at  different 
depth  locations  would  move  at  different  speeds.  It  was  best 
to  have  the  center  of  rotation  somewhere  near  the  middle  of 
the  object  to  get  maximum  contrast  of  motion  due  to  depth. 

Rotation  around  the  x  axis  could  be  very  disorienting 
because  the  picture  goes  upside  down  once  every  oscillation. 
This  left  rotation  about  the  y  axis  as  the  best  choice  of 
the  three. 

Simply  rotating  about  the  y  axis  on  the  screen  moved 
each  point  on  the  screen  back  and  forth  in  the  x  plane.  It 
was  found  to  be  helpful  to  tilt  the  entire  coordinate  system 
on  the  x  axis  first  before  rotating  in  the  y  axis.  This 
caused  descrete  points  making  up  the  picture  to  move  in 
ellipses  on  the  screen.  Ellipses  gave  a  better  indication 
as  to  exactly  where  each  point  was  in  the  picture.  A  tilt 
downward  around  the  x  axis  of  about  1 5  degrees  produced  the 
most  natural  looking  and  informative  picture. 

7.3*3  Oscillating  the  Picture 

Rotating  the  picture  completely  around  gave  the  best 
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overall  description  of  the  object  but  when  the  display  was 
being  used  to  control  the  manipulator,  it  was  hard  to 
distinguish  between  front,  back,  and  sideways,  as  they  where 
always  changing.  A  better  way  of  moving  the  picture  was 
found  for  situations  where  picture  orientation  had  to  be 
known.  Instead  of  rotating  completely  around,  the-  picture 
was  just  rotated  back  and  forth  with  a  sine  wave  controlling 
the  y  angle.  This  way  the  orientation  was  not  disturbed 
much  and  the  3-dimensions  were  still  apparent.  An  amplitude 
of  10  degrees  with  a  period  of  2  seconds  produced  a  useful 
picture.  The  problem  with  this  display  was  that  the 

operator  sometimes  had  to  wait  for  the  full  cycle  to  finish 

0 

before  getting  his  bearings  and  making  another  move. 

7.3*4  Rotation  with  a  Joystick  or  Trackball 

All  the  rotations  done  previously  were  controlled  by 
the  keyboard  and  did  not  require  ,or  allow,  much  direct 
attention.  Sometimes  it  could  be  very  useful  to  be  able  to 
position  the  picture  in  any  view  very  rapidly.  There  was 
available  a  trackball  and  joystick  that  were  built  to 
provide  this  type  of  control.  They  could  be  wired  to  the 
computer  to  control  the  display  angles. 

7.3*5  Position  Control 

The  3-degree  of  freedom  joystick  that  was  used  put  out 
a  voltage  related  to  the  position  of  the  joystick.  This 


voltage  was  used  to  control  the  3  angles  fed  into  the 
display  transformations  matrix,  as  shown  in  Fig.  7.2a.  The 
order  of  angle  transformation  used  was,  first  rotation 
around  the  z  axis,  then  the  y  axis,  and  then  the  x  axis.  It 
was  important  to  transform  the  z  axis  first  because  that 
made  the  display  move  most  similar  to  the  joystick.  A 
potentiometer  was  mounted  on  the  joystick  box  to  control  the 
maximum  allowable  angles  that  the  display  could  be  put 
through.  The  display  could  be  viewed  from  any  angle  but 
would  bounce  back  to  zero  when  the  joystick  was  let  go. 

7.3*6  Velocity  Control 

In  velocity  control  it  was  most  convenient  to  rotate 
the  display  in  screen  coordinates,  as  shown  in  Fig.  7.2b. 
This  allowed  the  picture  to  rotate  independently  of  of  the 
orientation  of  the  object  coordinates.  When  angles  are 
changed  with  respect  to  object  coordinates  it  was  not  always 
apparent  which  way  the  picture  would  turn  for  a  given  input 
if  the  object  was  already  rotated  through  some  other  angles. 

The  x-y  inputs  available  from  the  trackball  were 
sufficient  to  position  the  display  because  only  two  angular 
veloceties  were  required  to  maneuver  the  display  when  using 
screen  rotations.  With  the  joystick,  all  3  inputs  were  used 
even  though  they  were  redundant.  This  allowed  somewhat 


faster  control  of  the  picture  position. 

Rotation  in  screen  coordinates  was  done  with  the  same 


Fig 
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a.  Screen  Coordinates  and  Rotations 


b.  Object  Coordinates  and  Rotations 


.  7.2:  Screen  and  Object  Coordinates 
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transformation  matrix  as  rotation  in  object  coordinates. 
The  difference  is  that  the  transformation  was  completely 
recalculated  each  cycle  when  rolling  in  object  coordinates 
and  was  only  modified  for  screen  coordinates.  The  display 
transformation  matrix  was  saved  from  the  last  iteration  and 
multiplied  by  an  incremental  transformation  matrix  that  was 
the  same  as  the  object  transformation,  but  which  reflected  a 
very  small  angle  change.  It  did  not  matter  in  which  order 
the  x,  y,  and  z  rotations  were  multiplied  by  the 
transformation  because  it  made  little  difference  for  small 
angle  changes.  It  would  seem  that  the  transformation  matrix 
would  degenerate  from  floating  point  round-off  when  it  was 
continually  remultiplied  by  another  matrix  but  this  was  not 
observed  to  happen  and  the  display  did  not  seem  to  lose 
integrity  even  after  many  rotations. 

For  versatility,  rotations  in  screen  coordinates  were 
found  to  be  the  best.  Also,  the  capability  to  rotate 
directly  on  the  screen  z  axis  in  addition  to  the  x  and  y 
axes  was  useful  and  time-saving  even  though  it  was 
redundant . 

7.4  Improving  the  Display  for  Polyhedra 


7.4.1  Showing  All  Edges 

The  construction  of  a  polyhedron  out  of  a  set  of  points 
offered  several  methods  of  improving  display  quality.  The 
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obvious  way  to  display  a  polyhedron  constructed  in  the 
method  shown  in  Chapter  6.  was  to  just  show  all  edge  lines. 


The  edge  lines  could  be  constructed  from  the  facet  data 
because  each  edge  was  defined  twice,  once  in  two  different 
facets  and  always  directed  in  opposite  directions.  The 
algorithm  used  to  connect  the  points  on  the  display  simply 
went  through  the  data  and  drew  a  line  when  two  connected 
points  on  a  facet  were  found  in  increasing  order.  A 
complete  picture  could  be  made  of  a  polyhedron  consisting  of 
40  facets  in  about  50  milliseconds. 

This  particular  type  of  polyhedron  display  was  used 
most  frequently  because  it  was  so  fast  to  construct.  In 
fact  this  display  was  completely  reconstructed  every  tine  a 
facet  was  changed.  It  did  not  produce  an  especially  clear 
picture  but  rotating  it  did  help.  No  attempt  was  made  to 
remove  hidden  lines  from  this  display  because  it  would  take 
too  much  computing  time. 

7.4.2  Drawing  Contour  Lines 

It  was  a  straightfoward  problem  to  draw  contour  lines 
around  the  outside  surface  of  a  polyhedron,  because  the  data 
for  each  of  its  facets  were  stored  in  memory.  The  only 
outside  information  required  by  the  computer  was  the  number 
of  contour  sections  to  draw.  The  gap  between  sections  was 
automaticly  figured  from  the  overall  size  of  the  polyhedron. 

The  contours  were  all  made  on  the  z  plane  and  each 


contour  was  calculated  and  drawn  in  sequence.  For  each 
contour  plane  every  facet  in  the  polyhedron  was  checked  to 
see  if  it  passed  through  that  plane.  When  one  did  pass 
through  then  the  endpoint  coordinates  of  the  line  segment 
defining  the  facet  cut  were  calculated  by  interpolation.  If 
the  polyhedron  was  without  holes  or  folded  surfaces  then  the 
contour  drawn  at  any  section  would  be  a  closed  polygon. 

Drawing  contours  was  found  to  be  the  best  way  display  a 
polyhedron  on  a  vector  graphic  display.  The  shape  of  the 
object  was  well  defined  by  two  aspects  of  the  contours.  One 
was  that  the  directions  tnat  the  contour  lines  went  in  gave 
an  indication  of  the  angle  the  facets  had  relative  to  the  z 
axis.  The  other  aspect  was  that  the  density  of  contour 
lines  on  one  facet  indicated  the  angle  the  facet  had  with 
respect  to  the  z  plane.  The  line  density  of  the  facets  also 
produced  a  sort  of  shading  effect  that  gave  an  immediate 
sense  of  3-dimensionality.  When  the  polyhedron  with 
contours  was  rotated  the  picture  became  very  well  defined. 
Any  errors  in  the  polyhedron  became  painfully  obvious 
because  any  facets  sticking  through  other  facets  could  be 
readily  seen.  Also  if  any  facets  folded  over  on  top  of  each 
other  the  picture  became  very  bright  in  that  area. 

7.4.3  Raster  Graphic  Display 

Raster  graphics  was  experimented  with  to  see  how  well  a 
3-D  polyhedron  could  be  displayed.  It  was  also  used  to  show 


-76- 


how  easily  polyhedron  data  as  described  in  diaper  6.  could 
be  processed  by  a  computer. 

The  difference  between  raster  graphics  and  vector 
graphics  is  that  the  raster  graphics  beam  sweeps  out  the 
entire  screen  and  its  picture  is  changed  by  variations  in 
intensity  like  a  television  picture.  The  vector  graphics 
beam  traces  out  each  of  the  lines  and  points  individually . 
An  advantage  of  raster  graphics  is  that  surfaces  can  be 
simulated  better  because  shading  is  possible  and  it  is  also 
easier  to  delete  hidden  lines  and  surfaces. 

The  primary  disadvantage  of  the  raster  display  used  in 
the  experiments  was  that  it  was  much  slower  at  drawing 
pictures  than  the  vector  display.  This  made  real-time 
rotations  impossible  so  the  raster  graphics  was  used 
primarily  to  make  static  copies  of  polyhedra. 

To  draw  a  polyhedron  on  the  raster  display  it  first  had 
to  be  constructed  with  uhe  vector  display.  The  polyhedron 
was  then  framed  in  the  vector  screen  to  the  view  desired  to 
come  out  on  the  raster  display.  When  this  was  done  all  the 
polyhedron  data  was  stored  in  a  data  file.  The  3-D  point 
locations  were  stored  in  screen  coordinates  to  preserve  the 
view  chosen  for  the  display.  This  data  was  then  read  by  a 
second  program  that  put  the  polyhedron  on  the  raster 
display.  The  triangles  of  the  polyhedron  were  drawn  one  at 
a  time  on  the  display  according  to  their  x-y  coordinates. 
The  shade  of  each  triangle  was  determined  by  comparing  the 
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angle  of  the  surface  normal  to  a  space  vector  simulating  a 
light  source  direction.  Triangles  facing  away  from  the 
screen  were  not  drawn  at  all.  It  had  to  be  known  how  the 
facets  lay  in  3-3pace  and  which  side  of  each  facet  faced  out 
to  accomplish  shading.  This  was  another  advantage  of 
storing  facets  as  described  in  Chapter  6. 

If  the  polyhedron  had  any  concave  areas,  it  was  likely 
that  there  were  several  facets  partially  hidden  by  other 
facets.  By  its  nature,  raster  graphics  will  automaticly 
draw  a  new  triangle  right  over  an  old  one  so  all  that  is 
required  is  that  hidden  triangles  be  drawn  before  the 
non-hidden  ones.  The  method  used  to  draw  the  facets  in  the 
correct  sequence  was  very  simple.  The  point  on  each  facet 
with  the  maximum  z  value  (nearest  point)  was  the  only  one 
considered  to  decide  facet  order.  The  facets  were  ordered 
such  that  the  ones  with  a  minimum  value  for  this  point  were 
drawn  first  and  ones  with  higher  values  were  drawn  last. 
There  were  some  situations  where  this  algorithm  would  give 
wrong  answers  but  so  long  as  the  object  to  be  displayed  was 
not  a  radical  shape  and  there  were  a  reasonable  number  of 
facets  defining  each  feature  there  would  be  no  overlapping 
facets  drawn  in  the  wrong  order.  This  type  of  shading 
display  made  the  best  picture  when  there  were  smooth 
transitions  between  facets. 

It  was  found  to  be  advantageous  to  be  able  to 
interactively  change  the  location  of  the  light  source  to  a 
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position  where  the  3-dimensionality  of  the  polyhedron  was 
most  apparent.  Due  to  the  nature  of  the  raster  graphics 
hardware  used  it  was  very  slow  while  drawing  the  polyhedron 
but  once  drawn  the  shades  of  the  individual  triangles  could 
be  changed  very  fast.  The  trackball  was  used  to  input 
changes  in  x-y  angles  for  the  location  of  the  light  source 
from  the  center  of  the  screen.  The  apparent  light  source  on 
the  polyhedron  could  be  changed  rapidly  by  recalculating  all 
the  new  shades  for  each  triangle  and  sending  them  to  the 
display.  The  shades  could  be  changed  fast  enough  that  the 
light  source  could  be  moved  almost  in  real  time,  (  about  200 
milliseconds  to  change  a  polyhedron  with  50  exposed  facets). 
This  progressively  changing  light  source  brought  out 
3-dimensionality  very  well. 

Using  raster  graphics  to  display  polyhedra  can  make 
them  look  very  natural  from  a  human  point  of  view.  They  can 
even  be  made  somewhat  dynamic  by  moving  the  light  source. 
However  it  was  impractical  to  rotate  the  picture  in  real 
time  with  the  equipment  available. 
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CHAPTER  8: 


EVALUATION 


9 . 1  Number  of  Points  to  Make  a  Picture 

The  quality  of  a  picture  consisting  of  points  in  space 
depends  very  much  on  the  density  of  points  in  the  picture. 
If  too  many  points  were  shown,  the  picture  would  be  w.iite 
and  nothing  could  be  seen.  Too  few  points,  and  the  picture 
would  convey  nothing.  Somewhere  in  between  is  a  region 
where  there  are  just  enough  points  to  describe  what  is 
required  to  be  seen. 

Presumably  the  minimum  number  of  points  is  dependent  on 
the  number  of  distinguishing  features  to  be  shown  in  the 
picture.  A  distinguishing  feature  could  be  any  simple 
surface  section  of  the  object  to  be  investigated.  These 
features  would  have  somewhat  rounded  profiles  and  would  be 
either  flat  planes  or  slightly  curved  planes.  Any  features 
with  sharp  edges  would  have  to  be  broken  into  smaller 
more-rounded  features.  As  an  example,  a  cube  could  consist 
of  six  distinguishing  features,  one  for  each  of  its  sides. 
A  sphere  could  consist  of  just  one  curved  feature,  or 
perhaps  it  should  consist  of  several  features  to  reduce  the 
total  angular  change  per  feature.  There  is  no  correct 
answer,  but  it  is  required  that  a  degree  of  magnitude  be 
found  for  the  amount  of  points  required  to  describe  an 
object.  As  a  te3t,  the  number  of  points  needed  to  describe 
one  side  of  a  cube  and  the  number  needed  to  describe  the 


surface  of  a  sphere  were  estimated  and  compared  to  get  an 
upper  and  lower  bound  for  the  number  of  points  required  to 
describe  a  "feature". 

Figures  8.1  thru  8.4  show  how  recognizable  a  cube  and  a 
sphere  can  be  made  with  different  point  densities  for  dot 
and  polyhedron  displays.  It  can  be  seen  that  a  cube 
described  by  points  does  not  become  recognizable  until  there 
are  at  least  500  points  on  the  cube.  Although  it  cannot  be 
shown  here,  the  cube  became  recognizable  with  only  200 
points  if  it  was  rotated  on  the  screen.  The  sphere  became 
apparent  with  only  100  points  rotated  or  not.  Perhaps  this 
was  because  a  sphere  looks  the  same  from  any  view.  A  cube 
shown  with  the  points  connected  into  a  polyhedron  became 
fairly  recognizable  with  only  50  random  points.  It  must  be 
kept  in  mind  though  that  8  well  placed  points  can  perfectly 
describe  a  cube.  The  sphere  still  needed  about  100  points 
to  look  like  a  sphere  even  when  the  points  were  connected. 
This  may  be  because  the  curved  lines  of  a  sphere  are  not 
suited  for  description  by  the  straight  edges  of  a 
po lyhedron. 

Since  a  cube  requires  500  random  points  to  describe  its 
surface,  then  85  points  are  required  to  describe  one  of  its 
six  distinguishing  features.  A  sphere  still  requires  100 
points,  assuming  it  consists  of  only  one  feature.  For 
polyhedrons,  a  cube  feature  needs  about  20  points  and  a 
sphere  requires  100.  It  will  be  assumed  here  that  all 
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Pig.  8.1  Cubes  Described  by  Randomly  Distributed  Points 
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Pig.  8.2  Random  Cube  Points  Made  Into  Polyhedron 
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Pig.  8.3  Spheres  Described  by  Randomly  Distributed  Points 


distinguishing  features  on  any  object  "equire  about  the  same 
amount  of  randomly  distributed  points  to  define  its  shape 
for  a  human.  Different  sized  features  would  also  require 
the  same  amount  of  points,  they  would  just  have  different 
point  densities. 

Any  object  can  be  broken  into  arbitrarily  small 
features  depending  on  the  degree  of  detail  required.  Say  an 
area  in  front  of  a  manipulator  must  be  completely  described 
by  touch  points  and  it  is  necessary  that  all  features  down 
to  three  inches  across  must  be  recognizable.  This  means  the 
entire  area  must  be  covered  with  a  point  density  sufficient 
to  describe  a  3  inch  feature.  If  the  area  to  be 
investigated  is  20  square  feet  and  a  suface  feature  is 
assumed  to  require  100  points  to  be  well  described,  then  the 
entire  area  would  have  to  be  covered  with  32000  points  to 
describe  all  features  down  to  3  inches  across.  If  the 
points  are  to  be  connected  into  polyhedrons,  then  it  can  be 
assumed  that  only  20  points  are  needed  per  feature,  6400 
points  will  be  required  to  cover  the  entire  area. 

The  above  figures  are  probably  exaggerated  because  the 
manipulator  operator  is  allowed  to  choose  where  he  wants  to 
put  a  high  concentration  of  points.  He  can  leave  some  areas 
with  very  few  points  if  he  decides  they  are  unimportant. 
Also,  if  the  picture  can  be  rotated,  the  number  of  required 
points  can  be  greatly  reduced. 

A  problem  unique  to  points  that  were  connected  into 
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polyhedrons  was  that  the  surface  of  the  polyhedron  could 
become  degraded  if  the  points  were  too  densily  packed 
together.  That  is,  if  the  points  were  closer  together  than 
the  positioning  error  of  the  manipulator,  then  lines 
connected  between  them  would  not  likely  lay  parallel  to  the 
actual  surface.  These  points  would  make  a  very  jagged 
surface  on  a  polyhedron.  One  solution  would  be  to  delete 
points  that  are  to  close  to  other  points.  This  will  not 
reduce  the  resolution  because  it  is  already  limited  by  the 
manipulator  accuracy. 

8.2  Speed  of  Picture  Construction 

8.2.1  Gonstuction  Time  for  Points 

The  amount  of  time  required  to  read  points  from  the 
touch  sensor  and  then  draw  them  on  the  display  was  very 
short.  When  using  a  single  touch  sensor  switch,  one  point 
could  be  read  in  at  every  cycle  of  the  program.  One  cycle 
took  about  20  milliseconds  so  conceivably  50  points  could  be 
read  within  one  second.  The  computer  could  read  points  even 
faster  with  the  brush  sensor  because  it  had  10  switches. 
The  limiting  factor  was  not  how  fast  computer  could  read 
points  but  the  speed  the  touch  sensor  could  respond.  The 
single  touch  sensor  could  not  be  moved  fast  enough  to  read 
more  than  2  or  3  points  per  second  and  the  brush  sensor  was 
not  ~uch  faster  because,  although  it  could  read  many  points 


at  once,  it  was  more  cumbersome  to  maneuver. 

Clearly,  a  touch  sensor  is  required  that  can  read 
points  very  rapidly  if  a  picture  of  a  manipulator's 
surroundings  is  to  be  made  in  a  reasonable  amount  of  time. 
A  fast  touch  sensor  could  be  made  if  it  had  many  switches 
and  if  it  was  set  up  such  that  the  switches  did  not 
interfere  with  one  another,  (see  Chap.  2).  This  type  of 
sensor  would  be  considerably  more  expensive  than  the  ones 
used  in  this  project  but  would  probably  be  worth  it  for  the 
amount  of  time  that  would  be  saved.  Another  way  to  increase 
speed  would  be  to  make  a  sensor  that  could  stream  points  in 
without  having  to  lift  off  the  surface  for  every  point.  A 
streaming  sensor  would  work  best  if  it  was  non-rigidly 
mounted  to  the  manipulator  .  That  way  the  manipulator  would 
not  have  to  follow  every  bend  and  corner  encountered  on  the 
surface. 

As  an  example,  assume  the  maximum  point  coordinate 
reading  rate  of  the  computer  is  200  points  per  second.  If  a 
touch  sensor  was  built  with  20  switches  on  it,  then  the 
computer  would  be  capable  of  reading  10  points  per  second 
per  switch.  This  rate  would  not  be  unreasonable  if  the 
switches  were  made  to  stream  points  in.  A  touch  sensor 
capable  of  reading  points  at  200  per  second  could 
essentially  cover  any  surface  encountered  with  a  thick  mat 
of  points  in  a  very  short  time. 
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8.2.2  Construction  Time  for  Polyhedra 

The  speed  of  the  computer  was  the  limiting  factor  for 
construction  of  polyhedra.  The  time  period  required  to 
attach  a  new  point  went  up  with  the  number  of  facets  on  the 
polyhedron.  Pig.  8.5  shows  a  graph  of  average  time 
required  to  attach  a  new  point  versus  the  number  of  points 
in  the  polyhedron  for  the  computer  program  in  Appendix  B. 

There  are  many  areas  of  this  program  that  could  be  made 
to  run  much  faster  at  the  expense  of  more  program 
complexity.  To  attach  a  new  point,  the  program  had  to  test 
every  facet  of  the  polyhedron  for  suitability.  This  was 
very  time  consuming.  For  this  reason  a  condition  was  added 
that  the  computer  only  make  complete  tests  on  the  five 
facets  with  nearest  centroids  to  the  new  point.  This 
condition  increased  the  speed  of  the  program  by  a  factor  of 
two.  Other  parts  of  the  program  could  have  used  this  same 
kind  of  selectivity.  For  example,  after  a  facet  was  chosen 
for  attachment,  all  the  other  facets  had  to  be  checked  to 
see  that  they  did  not  get  in  the  way.  Also,  all  the  facets 
and  all  the  touch  vectors  had  to  be  checked  for  interference 
before  a  pair  of  facets  could  be  changed.  These  checks 
significantly-  slowed  computation. 

Perhaps  the  thing  that  contributed  most  to  slowing  the 
program  was  the  basic  philosophy  that  points  should  be 
attached  to  the  polyhedron  in  the  order  they  were  found  by 
the  operator.  If  all  the  points  could  be  known  at  the  start 


-90- 


and  arranged  in  the  best  sequence  for  attachment,  many  of 
these  extensive  comparisions  and  checks  might  be  eliminated. 
This  might  also*allow  the  points  to  be  seperated  into  small 
groups  and  connected  together  in  patches  to  further  increase 
speed. 

8. 3  Raster  Display 

Drawing  a  picture  of  the  polyhedron  on  the  raster 
display  was  much  slower  than  any  other  method  tested.  One 
facet  of  the  polyhedron  could  be  drawn  on  the  display  in 
about  half  a  second  so  real-time  rotation  of  the  picture  was 
impossible.  Raster  graphic  hardware  is  available  on  the 
market  that  will  draw  a  picture  much  faster  but  can  be  very 
complex.  The  raster  display  was  best  used  for  making 
permanent  pictures  because  it  was  capable  of  making  them 
look  very  realistic. 
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CHAPTER  9 


C ONCLJSIONS  AND  R2CQM3NDATIONS 


9 • 1  Conclusions 

This  project  has  shown  that  a  supervisory  controlled 
manipulator  can  be  used  to  construct  an  understandable 
3-dimensional  picture  of  its  surroundings  with  just  the 
sense  of  touch.  The  picture  can  consist  simply  of  surface 
points  shown  on  a  computer  graphic  display.  It  is  also 
shown  how  a  more  sophisticated  picture  can  be  made  by 
reconstructing  a  surface  from  these  points.  Not  only  can  a 
picture  be  made  that  is  recognizable  to  a  human,  3-D  surface 
data  that  is  easily  digestable  by  a  computer  is  also 
provided. 

In  situations  where  vision  of  the  manipulstor  work  area 
by  the  operator  is  difficult  or  impossible,  these  methods  of 
touch  sensor  picture  construction  could  be  a  good  aid  or 
replacement  for  the  usual  television  camera. 

9. 2  Recomendations 

A  touch  sensor  would  have  to  be  developed  that  could 
sense  points  very  rapidly  for  touch  generated  pictures  to  be 
of  practical  use.  That  way  a  picture  could  be  essentially 
"painted"  with  the  sensor.  Axso  the  surface  construction 
program  would  have  to  be  made  to  go  faster  to  be  able  to  use 
it  ir.  real-time.  This  should  not  be  impossible  as  the 
number  of  required  calculations  to  attach  each  point  to  the 


AD-A116  912 


MASSACHUSETTS  INST  OF  TECH  CAMBRIDGE  MAN-MACHINE  SYS— ETC  F/G  17/8 
COMPUTER  GRAPHIC  REPRESENTATION  OF  REMOTE  ENVIRONMENT  USING  POS — ETCtU) 
AUG  81  D  C  FYLER  N00014-77-C-0256 


UNCLASSIFIED 

2o  v2| 


I6S  l? 


CHAPTER  9 


CONCLUSIONS  AND  RSCOMSNDATIONS 


9*1  Conclusions 

This  project  has  shown  that  a  supervisory  controlled 
manipulator  can  be  used  to  construct  an  understandable 
3-dimensional  picture  of  its  surroundings  with  just  the 
sense  of  touch.  The  picture  can  consist  simply  of  surface 
points  shown  on  a  computer  graphic  display.  It  is  also 
shown  how  a  more  sophisticated  picture  can  be  made  by 
reconstructing  a  surface  from  these  points.  Not  only  can  a 
picture  be  made  that  is  recognizable  to  a  human,  3-D  surface 
data  that  is  easily  digestable  by  a  computer  is  also 
provided. 

In  situations  where  vision  of  the  manipulstor  work  area 
by  the  operator  is  difficult  or  impossible,  these  methods  of 
touch  sensor  picture  construction  could  be  a  good  aid  or 
replacement  for  the  usual  television  camera. 

9 • 2  Re come ndat ions 

A  touch  sensor  would  have  to  be  developed  that  could 
sense  points  very  rapidly  for  touch  generated  pictures  to  be 
of  practical  use.  That  way  a  picture  could  be  essentially 
"painted"  with  the  sensor.  Also  the  surface  construction 
program  would  have  to  be  made  to  go  faster  to  be  able  to  use 
it  in  real-time.  This  should  not  be  impossible  as  the 
number  of  required  calculations  to  attach  each  point  to  the 
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polyhedron  can  be  held  to  a  maximum  value. 

There  are  many  aspects  of  surface  construction  from 
points  that  could  use  further  study: 

1. )  A  method  is  needed  to  decide  if  there  should  be 
more  than  one  polyhedron  or  surface  in  front  of  the 
manipulator.  This  in  turn  leads  to  the  problem  of  attaching 
or  detaching  different  polyhedra  from  each  other. 

2.  )  An  interesting  problem  would  be  to  find  a  method  to 
construct  polyhedra  with  holes  passing  through  them.  A 
polyhedron  with  a  hole  does  not  follow  Euler's  Formula. 

3. )  No  allowance  was  made  in  this  study  for  a  moving 
object.  If  the  motion  were  known  then  there  ought  to  be  a 
way  to  compensate  for  this  in  the  construction  on  the 
screen. 
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APPENDIX  I. 


COMPUTER  PROGRAM  DESCRIPTION 

Interdependent  tasks  such  as  manipulator  simulation, 
vector  graphic  display,  and  polyhedron  construction  where 
all  combined  in  one  Fortran  4-Plus  program  because  it  was 
most  practical  that  they  all  work  at  the  same  time.  Raster 
graphic  display  was  done  on  a  seperate  program  as  it  did  not 
have  to  run  in  real-time. 

MAIN  PROGRAM 

The  main  program,  TOUCH,  handled  manipulator 
simulation,  touch  sensing,  and  program  initialization. 
TOUCH  was  basicly  a  stripped  down  version  of  C.  Winey's  ARM 
program  [  1  ].  Only  those  parts  that  were  required  for 
manipulator  simulation  were  saved  because  cycle  time  was 
critical.  The  touch  sensing  capability  was  added  and  took 
care  of  locating  points  and  touch  vectors  any  time  a  touch 
sensor  switch  was  found  to  be  tripped.  Also  some  algorithms 
were  added  to  improve  absolute  point  coordinate  calculation 
as  described  in  Chapter  5* 

When  running,  the  processor  would  simply  loop  through 
TOUCH  continually  refreshing  the  manipulator  display  and 
waiting  for  an  outside  command.  Control  would  be  transfered 
to  subroutine  DI3P  in  the  event  of  a  keyboard  input  or  to 
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subroutine  COW  if  a  touch  sensor  tripped  when  a  polyhedron 
was  being  constructed.  Cycle  time  through  TOUCH  was  about 
20  milliseconds  which  was  fast  enough  to  simulate  a  smooth 
moving  manipulator  and  give  it  a  reasonably  good  reaction 
time  to  respond  to  touch  inputs. 

Subroutine  DISP  responded  to  any  keyboard  inputs  and 
took  care  of  display  managment.  It  controlled  view  angle, 
set  program  parameters,  and  organized  information  output. 
It  was  responsible  for  creating,  deleting,  and  starting 
construction  of  polyhedra.  DISP  was  called  every  cycle  of 
TOUCH  when  it  was  required  that  the  display  be  dynamicly 
rotated  or  moved.  This  increased  cycle  time  to  26 
milliseconds. 

Subroutine  CON  took  care  of  adding  new  points  to  an 
existing  polyhedron.  If  no  polyhedron  existed,  CON  would  do 
the  process  of  initialization  described  in  Chapter  6.  CON 
decided  which  was  the  best  facet  to  attach  to  and  made  sure 
that  it  did  not  violate  any  rules  for  a  closed  polyhedra. 
After  the  point  was  attached  CON  did  the  job  of  deciding 
which  facet  pairs  to  check  for  smoothing. 

Subroutine  PACE  compared  facet  pairs  and  decided  when 
they  should  be  switched  with  compliment  facets.  It 
determined  the  angles  between  neighboring  facets  and  checked 
that  new  facets  did  not  violate  any  rules  for  closed 
polyhedra.  PACE  was  be  called  by  CON  when  checking  facet 
pairs  and  could  also  be  called  by  DISP  when  the  operator 
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wanted  to  check  or  change  facets  from  the  keyboard. 

Subroutine  CTOUR  drew  evenly  spaced  contour  lines 

across  the  existing  polyhedron.  'These  contour  lines  were 
always  drawn  on  the  object  coordinate  z  plane. 

Subroutine  JROL  performed  rotations  in  screen 

coordinates  for  control  by  the  joystick  or  trackball. 

The  following  list  of  subroutines  took  care  of 
individual  tasks  that  were  often  required  by  main 
subroutines. 

Subroutine  PISRC  compared  relationships  between  a  line 
and  a  triangle.  It  determined  if  the  line  pierced  through 
the  triangle,  if  the  triangle  faced  away  from  the  base  of 
the  line,  and  if  the  line  pointed  away  from  the  triangle. 
It  could  also  determine  the  distance  along  the  direction  of 
the  line  from  the  base  of  the  line  to  the  plane  described  by 
the  triangle.  PIERC  was  used  to  determine  if  two  facets 

were  concave  or  convex,  if  a  touch  vector  was  at  an  angle 

greater  than  90  degrees  to  a  facet,  or  if  a  line  segment 
stuck  through  a  facet. 

CROSS  -  determined  the  normal  vector  of  a  plane  described  by 
three  points  in  3-space. 

ANGL  -  determined  the  angle  difference  between  two  vectors 
in  3-space. 

SEARCH  -  found  the  third  point  of  a  facet  on  an  existing 
polyhedron  if  given  the  two  other  points  in  sequence  for 


that  facet. 


VECT  -  drew  a  line  on  the  screen  between  two  specified  touch 
points. 

The  following  are  the  set  of  library  subroutines  that 
were  used  to  control  the  vector  graphics  display  processor: 

MGINIT  -initialize  the  Megatek 

MGS END  -sand  data  in  display  buffer  to  Megatek 

SETINT  -set  the  light  intensity  for  all  lines  drawn  after  it 

DRWI3  -draw  a  3-D  line 

MOV I 3  -move  to  a  new  3-D  location  without  drawing  line 
PNTI3  -draw  a  point  in  3-D 

NPOINT  -find  last  line  number  being  used  by  Megatek 
MODIFY  -modify  next  command  in  Megatek  with  next  call 
LDPTRO  -reset  beginning  of  Megatek  display  and  erase 
everything  after  it 

LDTRN3  -send  transformation  coefficients  for  rotation, 

translation,  and  zoom  for  all  lines  drawn  after  it 

RASTER  DISPLAY 

The  program  DRW  read  3-dimensional  points  and 
polyhedron  data  from  a  data  file  from  DISP.  The  points  were 
preformatted  on  the  vector  graphic  display.  DRW  drew  all 
the  facets  facing  toward  the  screen  on  the  Lexidata. 
Furthermost  facets  were  drawn  first  so  that  they  would  be 
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erased  if  a  closer  facet  was  in  front  of  them.  Shading  was 
accomplished  by  relating  a  facet  to  the  angle  between  a 
facet  normal  and  a  vector  simulating  a  light  source 
direction.  The  light  source  direction  could  be  changed  with 
a  trackball  very  quickly  by  changing  the  shading  lookup 
table. 

The  following  are  a  list  of  subroutines  used  to  read 
the  trackball  and  control  the  Lexidata: 

TBALL  -  read  trackball  x  and  y  velocities  and  the  combined 
value  of  three  switoaes. 

DSVEC  -  drew  a  line  between  two  points  and  selected  a 
shading  lookup  number. 

DS1LU  -  changed  the  shade  of  one  lookup  number. 

DSLWT  -  changed  the  shades  of  many  lookup  number  according 
to  an  array. 
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APPENDIX  B1  . 


AND  SURFACE  POINTS 

PROGRAM  TOUCH 
C  INITIALIZE  PROGRAM 

DIMENSION  IPT  (4  )  ,XX(4  )  ,XY(4  )  ,XZ  (4  )  ,  XT  (4  )  ,YX(4  )  ,YY(4  ) 
DIMENSION  YZ  (4  ) ,  ZX(4  ) ,  ZY  (4  ) ,  ZZ  (4  ) ,  YT  (4  ) ,  ZT  (4  ) 
DIMENSION  SCL(7,2),IA(16).A(7) 

DIMENSION  IOSB (2 )  ,  IBUF  ( 1  2 ) ,  IPOT  (1  0)  ,MS  (10),  IPARAM  (6  ) 
COMMON  /DMABUF/  IDUM (2298 ) , ADAT (5 1 , 3 ) , 3RP (3 6, 3 ) , 

1  ICON (90, 2), IBRC (50,2) ,IPC (200,3), M  (100,3) 

COMMON  /FACT/IFMAX, NX(30) ,NA, IPS  NCON, NPOL, ICCN, 

1  IVECT  ISUP  IRX 

COMMON  /IPT PS/  IANG(1  00,2) , ICHECK, VEX 
COMMON  /DISPL/ICM, XXD, XYD, XZD, XTD, YXD , YYD , YZD , 

1  YTD, ZXD, ZYD, ZZD, ISHAD, I ARM, I WALL, I ROLL, JSTICK, IDOTR 
C  INITIALIZE  THE  MEGATEK  AND  A/D 
CALL  ANINIT 
CALL  MGINIT 
CALL  SETINT (1 3) 

CALL  NPOINT (IREP) 

C  INITIALIZE  THE  KEYBOARD  MONITER  ROUTINE 
CALL  GETADR( IPARAM (1 ) ,ICMD) 

IPARAM(2)=1 
IEXC=i"033 
LLL="1 14 
IAAA="1 01 

C  INITIALIZE  VIEW  AND  MENU 

100  IRX=-5 
CALL  DISP 
IRX=0 
ICM='M  14 
CALL  DISP 

C  SET  LINK  LENGTHS  AND  ORIGIN 
AY=55 . 625 
AZ=1 600. 

SZ=720 . 

Z0G=48O. 

Y0G=960. 

VEX=2 

C  READ  SCALING  FACTORS  FOR  A/D  OUTPUT  OF  ANGLES 
OPEN (UNIT =4 ,NAME=' SCALE.DAT ' ,TYPE='OLD’ ) 

READ  (4  ,  *)  ( (SCL(I,  J ) ,  J=1  ,2),  1  =  1 ,7) 

CL0SE(UNIT=4 ,DISPOSE= ' SAVE ' ) 

C  READ  POINT  DATA  FOR  MANIPULATOR 

OPEN (UNIT=4,NAME=’ARMSDT. DAT’ , TYPE= ' OLD' ) 

DO  101  1=1 ,60 

READ (4 , *,END=1 02) AD AT (1, 1  ) , ADAT (I, 2 ) , ADAT ( I, 3 ) 

101  CONTINUE 

102  CLOSE (UNIT=4 ,DISPOSE= ' SAVE ' ) 

C  READ  CONNECTIVITY  DATA  FOR  MANIPULATOR 

0PEN(UNIT=4  , NAME= ' ARMSCN.DAT ' , TYPE= ' OLD ' ) 

DO  103  1  =  1 ,100 
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READ  (4  ,  * , END=1  04 ) ICON ( I , 1 ) , ICON ( I , 2 ) 

103  CONTINUE 

104  CL0SE(UHIT=4, DISPOSE* 'SAVE' ) 

C  READ  POINT  DATA  FOR  TOUCH  SENSOR 

OPEN (UNIT=4,NAME*'BRSHDT.D AT '  , TYPE  ='OLD' ) 
DO  105  1=1,50 

READ (4 , * , END=1 06 ) BRP (1,1  ) , BRP (1,2), BRP (1,3) 

105  CONTINUE 

106  CLOSE (TJNIT=4, DISPOSE*  1  SAVE'  ) 

C  READ  CONNECTIVITY  DATA  FOR  TOUCH  SENSOR 

OPEN (UNIT=4, NAME* 'BRSHCN.DAT' ,TYPE='OLD' ) 

DO  107  1=1 ,50 

READ (4 , *, END=1 03) I3RC (1,1), IBRC (1,2) 

NBC ON = I 

107  CONTINUE 

108  CLOSE (UNIT=4 ,DISPOSE= 'SAVE ' ) 

C  INPUT  ARM  AND  NALL  LINES  INTO  MEGATEK 
IXXX=83+NBC0N 
DO  128  1=1 ,IXXX 
INK*I-NBCON 
IF(I.EQ. 1 )GOTO  34' 

IF(INK.EQ.36)G0T0  343 
IF ( INK. EQ. 56 )GOTO  342 
IF ( INK. EQ. 72) GOTO  344 
GOTO  346 

C  INPUT  TOUCH  SENSOR 

341  CALL  SETINT  (1  3 ) 

CALL  NPOINT (iPT  (2  )  ) 

IARM=IPT (2  )-1 

GOTO  345 
C  INPUT  SHOULDER 

342  CALL  NPOINT (IPT (3 ) ) 

GOTO  345 

C  INPUT  FOREARM 

343  CALL  NPOINT (IPT (4 ) ) 

GOTO  345 

C  INPUT  WALLS 

344  CALL  SETINT  (13) 

CALL  NPOINT ( IPT (1  )) 

IWALL=IPT(1 )-1 

345  CALL  LDTRN3(1 . ,0. ,0. ,3000. ,0. ,1 . ,0. ,0. ) 

346  IF( INK. LE.O )GOTO  250 
MR=ICON  (INK,  1  ) 

MM  =  ICON ( INK,  2 ) 

1X1  =40.  *ADAI(MR,1  ) 

1X2=40. *ADAT (MM, 1 ) 

IY1 =40. *ADAT (MR, 2 ) 

IY2=40 .  *ADAT  (MM ,  2  ) 

IZ1  =40.  *ADAT  (MR,  3) 

IZ2=40 . *ADAT (MM , 3 ) 

GOTO  24 3 

250  MR=IBRC ( 1,1) 
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MM=IBRC (1,2) 

1X1  =40 .  *BRP  (MR,  1  ) 

1X2=40.  *BRP(MM,1  ) 

IY1 =40.*BR?(MR,2) 

IY2=40. *BRP(HMf2) 

IS1  =40 .  *3RP  (MR,  3  ) 

IZ2=40.*BRP(MM,3) 

IP (1X1  . SQ.880. OR. 1X2. EQ.880 )GOTO  1 23 

249  CALL  M0VI3(IX1 , IY1 , IZ 1  ) 

CALL  DRWI3 ( 1X2 , IY2 , IZ2 ) 

C  SEND  TO  DISPLAY 

CALL  MGSEND 

128  CONTINUE 

129  CONTINUE 

C  SET  DISPLAY  AFTER  MANIPULATOR 
CALL  SETINT (13) 

CALL  NPOINT (NOON ) 

CALL  MGS END 

C  READ  ARM  POSITION  FROM  A/D  CONVERTER  AND  CONVERT  TO 

VOLTAGE 

C  READ  TOUCH  SENSOR  SWITCHES 

112  CALL  AINSQ ( 1 6 , 22 , IA  ) 

CALL  DIN(20, ISP) 

135  DO  1 13  1=1 ,7 

A ( I )=?LOAT (IA(I))/3276.2 

113  CONTINUE 

C  SCALE  A/D  OUTPUT,  FILTER,  AND  CALCULATE  SINES  COS IIIES 

914  THZ=SCL(1  ,1  )*A(5)+SCL(1  ,2) 

THX=SCL  (2,1  )  *A  (7  )+SCL  (2,2*) 

THYZ=SCL(3 , 1 ) *A  (6 )+SCL (3 »  2 ) 

THY=THYZ-THZ 

THA=SCL(4 , 1  )  *A (2  )+SCL (4 , 2 ) 

THR=SCL (5 » 1  )*A (3 )+SCL (5,2) 

THL=SCL  (6 , 1  )  *A  (4  )+SCL  (6 , 2 ) 

SI =SIN (THZ ) 

S2=SIN(THX1 
S4=SIN  (THA ) 

Cl  =COS  (THZ ) 

C2=C0S ( THX ) 

C4  =COS  (THA ) 

C  PREFORM  PUSHROD  CALCULATION 

ZP1 =-2. 25*S2-4 . 5*C2*CP3 

XGXP=3 • 1 -2 . 25*C2+4 . 5*32*CP3 

ZGZP=-4.5*C0S(THY)+2. 25*S2+4. 5*C2*CP3 

YP=4 . 5#SIN ( THY )+SQRT (324 . 72-XGXP*XGXP-ZGZP*ZGZP ) 

SP3=(YP-1  8.  )/4 .5 

THY1 =ASIN(SP3) 

CP3=C0S(THY1 ) 

C  ROTATE  JOINT  90  DEGREES 
S3=-CP3 
C3=3P3 

C  PREFORM  DIFFERENTIAL  CALCULATION 
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C  SH OYLOER  TRANSr  -Dw3 
XX ( 3 ) =C2 
XY (3 ) =-32 
YX(3)=C1 *32 
YY (3 :=C1 *C2 
YZ(3)=-31 
YY (3 ) =Y  00 
ZX  ( 3 ) =S2*31 
ZY(3)=S1 *C2 
zz(3)=ci 
ZT  (3  )  =  ZGO 

C  FOREARM  TRANSFORMATIONS 

XX(4  )=C2*C4-S2*C3*34 
XY  (4  )  =-C2*34-S2*C3*C4 
XZ  (4  )  =S2*S3 

YX(4  )=C1  *32*04  +01  *  "2  03*S4-S1  *S3*34 
YY (4 ) =-C1 *S2*S;+C1 *C2*G3*C4-S1 *33*04 
YZ (4 )  =  -C1 *C2*S3-S1 *03 
YT  (4  )  =31  *SZ+YOG 

ZX(4  )=31  *S2*C4+31  *C2*C3*S4+C1  *S3*34 
ZY (4 ) =-S1 *32*34+31 *02*03*04+01 *S3*C4 
ZZ(4 )=-S1 *02*33+01 *C3 
ZT (4 )  =  -C 1 *SZ+ZOG 

C  HAND  TRANSFORMATIONS 

XX (2  )  =XX(4  )  *C6+XY  )4  )*C5*S6+XZ  (4  )*S5*S6 

XY  ( 2  )  =-XX  (4  )  *S6+XY  (4  )  *C5*C6+XZ  (4  )  *S5*C6 

XZ  (2)  =  -XY(4  )*S5+XZ  (4  )*C5 

XT (2 ) =-XZ (4 ) *AZ+XY (4 ) *AY 

YX(2)=YX(4  )*C6+YY(4  )*C5*S6+YZ  (4  )  *35*36 

YY ( 2 ) =-YX (4 ) *36+YY (4 )*C5*C6+YZ (4)*S5*C6 

YZ  (2  '  =-YY  (4  )*S5+YZ  (4  )  *C5 

YT (2 ) =-YZ (4 ) *AZ+YT (4 )+YY(4)*AY 

ZX(2)=ZX(4  )*C6+ZY(4)*C5*S6+ZZ(4  )*S5*S6 

ZY (2 ) =-ZX (4 ) *S6+ZY (4 )*C5*C6+ZZ (4 ) *S5*Co 

ZZ(2)=-ZY(4  )*S5+ZZ(4  )*C5 

ZT ( 2 ) =-ZZ (4 ) *AZ+ZT (4 )+ZY (4 ) *AY 

C 

C  DO  DISPLAY  TRANSFORM  AND  SEND  TO  DISPLAY 
DO  371  1=2,4 

60  XXI  =XX( I ) *XXD+YX( I ) *XYD+ZX( I ) *XZD 

XY1 =XY ( I ) *XXD+YY ( I ) *XYD+ZY ( I ) *XZD 
XZ  1  =XZ ( I ) *XXD+YZ ( I ) *XYD+ZZ ( I ) +XZD 
XT  1 =XT ( I ) *XXD+YT ( I ) *XYD+ZT ( I ) *XZD+XTD 
YX1 =XX( I ) *YXD+YX( I ) *YYD+ZX( I ) *YZD 
YY1 =XY  C I ) *YXD+YY ( I ) *YYD+ZY ( I ) *YZD 
YZ  1  =XZ ( I ) *YXD+YZ ( I ) *YYD+ZZ ( I ) *YZD 
YT  1  -XT ( I )*YXD+YT ( I ) *YYD+ZT (I)*YZD+YTD 
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CALL  MODIFY (I?T (I )  ) 

CALL  LDTRN3 (XXI ,XY1 , XZ1 , XT1 ,YX1 ,YY1 ,YZ1 ,YT1 ) 

371  CONTINUE 

C  DO  WALL  TRANSFORMATION 

CALL  MODIFY  ( IPT  (1  )  ) 

CALL  LDTRN3 (XXD, XYD, XZD, XTD, YXD,YYD, YZD, YTD } 

C 

C  EXAMINE  TOUCH  SENSOR  SWITCHES 

IF ( ISP. EQ. "1 77777 )GOTO  372 
62  DO  372  1=1,10 

J=2** ( 1-1  ) 

C  PUT  WAIT  LIMIT  ON  SWITCHES  OF  4  CYCLES 
IF( ( ISP. AND . J ) . EQ.O ) IPOT (I ) =1 
IF ( IPOT (I ) . EQ. 0 . AND. MS ( I ) . GT .0 )MS ( I ) =MS ( I )-1 
IF ( IPOT ( I ) . EQ. 0 . OR.MS ( I ) . NE.O )GOTO  373 
MS (I )=4 

C  RING  TERMINAL  BELL  IF  QIO  IS  OFF 
NBEE?="007 

IF ( IRX. EQ. -4 ) WRITE (5 , 765)N3EEP 
765  FORMAT ('  ’ t  1  A 1  ) 

C  INCREMENT  POINT  COUNTER 
IPS=IP3+1 

C  FIND  SENSOR  CENTERLINE 
XP=BRP (1,1 )*40. 

YP=BRP(I,  2) *40. 

ZP=BRP (1,3) *40 . 

X3=BR?  ( 1+1  0, 1  )*40. 

YB=3RP ( 1+1 0,2) *40 
ZB=BRP  ( 1+1  0, 3 )  *40. 

C  DO  TRANSFORM  TO  GET  TOUCH  POINT  AND  VECTOR  IN 
C  MANIPULATOR  COORDINATES 

MMM X=X?*XX(2 )+Y?*XY (2 )+Z?*XZ (2 )+XT (2 ) 
MMMY=XP*YX(2)+YP*YY(2)+ZP*Y2 (2)+YT(2) 
MMMZ=XP*ZX(2)+YP*ZY(2)+ZP*ZZ(2)+Z?  (2) 

XBT=XB*XX(2 )+Y3*XY (2 )+ZB*XZ (2)+XT(2) 

YBT=X3*YX(2 )+YB*YY (2 )+Z3*YZ (2 )+YT (2) 
ZBT»XB*ZX(2)+YB*ZY(2)+ZB*ZZ(2)+ZT(2) 

IF (IDOTR. EQ. 1 ) WRITE (2, *)MMMX,MMMY,MMMZ 
IF (IPS. GT .  1  00) GOTO  374 
C  POINT  COORDINATES 

M ( IPS , 1 ) =MMMX 
M ( IPS , 2 ) =MMMY 
M ( IPS , 3 ) =MMMZ 

C  TOUCH  VECTOR  ANGLES  *10000  (TO  STORE  AS  INTEGERS) 

VL=SQRT ( (M ( IPS, 1 )-XBT)**2+(M(lPS,2)-Y3T)**2) 
IANG(IPS, 1 )=ATAN2 (YBT-M ( IPS, 2 ) , XBT-M (IPS, 1 ) ) *1 0000. 
IANG ( IPS , 2 ) =AT AN2 ( ZBT-M ( I PS , 3 ) , VL ) *1 0000 . 

C  DO  CONNECTION  IF  ENABLED 

IF ( ICON. NE. 1 )GOTO  374 
TIME=  SECNDS(O.O) 

CALL  CON 

TIME=SECNDS  (TIME) 
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IP (IRX. EQ.  -4 )TYPE  *, IPS, TIME 
C  RING  BELL  TO  INDICATE  COMPLETION 

IP ( IRX. SO. -4 ) WRITS (5 , 765 ) NBESP 
GOTO  373 

C  DRAW  POINT  ON  SCREEN 

374  C ALL  PUT 13 ( MMMX , MMMY , MMMZ ) 

CALL  MGS3ND 
373  IPOT ( I )=0 

372  CONTINUE 

C  ENA3LE  QIO  IP  ARM  IS  TWISTED 

IP ( IRX. EQ. -4 . AND . THA . GT . 3 . 0 ) IRX=0 
IF( IRX. EQ. -4 )GOTO  112 

C  CHANGE  DISPLAY  TRANSFORMATIONS  IP  VIEW  IS  CHANGING 
IF(IROLL. EQ. 1 )CALL  DISP 
IF ( IVECT . EQ. 2 )GOTO  1  1  2 
C  READ  KEYBOARD 

IPdPF.NE.I  ) CALL  QI0("10400, 5,3,  , IOSB, IPARAM , IDS ) 
IFF  =  1 

CALL  RSADEP(3 , IUU) 

IF( IUU. NE. 2 )GOTO  112 
ICM=ICMD 

WRITS(5,999)IEXC,LjjL,  IEXC.IAAA 
999  FORMAT ( '+ ' ,4A) 

IF?=0 
CALL  DISP 
ICM=0 

C  LOOK  AT  DISPLAY  FLAG 

382  IF(IRX.EQ.-1  )CALL  LDPTRO (NCON ) 

IF(IRX.EQ.-1 )CALL  MGSEND 
IF ( IRX. EQ. -2 ) GOTO  100 
GOTO  112 
END 
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APPENDIX  C.  SUBROUTINES  TO  CONSTRUCT  A  POLYHEDRON 

PROM  SURFACE  POINT  DATA 

SUBROUTINE  CON 

COMMON  /DM ABUF /  IDUM (3060 ) , NF (20) , ID (20) , 

1  IPC  ( 200 ,  3 ) ,  H  ( 1 00 , 3 ) 

COMMON  /IPTPS/IAN0(100,2) 

COMMON  /PACT /IFM AX, NX (30 ) , NA , I  PS , NCON, NPQL, ICCN, 

1  IVECT, ISUP.IRX 
C  INITIALIZE  VARIABLES 

NDIST=1 0  !  MAXIMUM  DISTANCE  TO  FACET  CENTROID 

NMAX=5  !  NUMBER  OP  FACETS  FOR  COMPLETE  CHECKS 
357  IPRC1 =0 
PD1  =0 
DL1  =0 
IB=0 
ITRY=0 
NFMX=NMAX 
PI=3- H15927 

IF  ( IPS .GT . 3 ) GOTO  3  ! IPS=CURRENT  NUMBER  OF  POINTS 

IF  (IPS.GT.1 ) GOTO  1 
C  DRAW  DOT  FOR  FIRST  POINT 

CALL  PNTI3(M(1 , 1 )  ,M  ( 1 ,2) ,M(1 ,3)  ) 

GOTO  5 

1  IF  ( IPS . GT . 2 )GOTO  2 

C  DRAW  LINE  BETWEEN  FIRST  2  POINTS 
CALL  VECT (1 ,2) 

GOTO  5 

C  CONSTRUCT  INITIALIZING  FACETS  ON  FIRST  3  POINTS 

2  CALL  VECT (2, 3) 

CALL  VECT (3,1 ) 

IFC (1 ,1 )=3  !  LOAD  FIRST  2  FACETS  FIRST  3  POINTS 

IFC  ( 1  ,  2  )=2 

IFC  (1 , 3 )  =  1 

IFC (2,1  )=1 

IFC (2 , 2 )=2 

IFC (2, 3)  =3 

IFMAX=2  !  NUMBER  OF  FACETS  ON  EXISTING  POLYHEDRON 
5  CALL  MGSEND 

RETURN 

3  CONTINUE 

DO  320  1=1 , 20 
ID  ( I )  =40 .  *NDIST 
320  ITF  ( I )  =0 

C  FIND  DISTANCE  FROM  POINT  TO  CENTROID  OF  ALL  FACETS 
DO  321  1=1  ,  IFMAX 
IFC1 =IFC (1,1  ) 

IFC2=IFC (1,2) 

IFC3=IFC(I,3) 

FXA  =  (M ( IFC1  , 1 )+M ( IFC2 , 1 )+M(IFC3, 1 ) ) /3 . -M ( IPS , 1 ) 
?YA=(M( IFC1  ,  2 )+M ( IFC2 , 2 )+M ( IFC3 , 2 ) ) /3 . -M ( IPS , 2  ) 

FS A= (M ( IFC1 , 3 ) +M ( IFC2 , 3 ) +M ( IFC3 , 3 ) ) /3 . -M ( IPS , 3 ) 
LD=SQRT (FXA*?XA+FYA*FYA+FZA*FZA ) 
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C  ADD  FACET  TO  LIST  OF  NEAREST  FACETS  IF  CLOSE  ENOUGH 
IF(LD.GE. ID (NMAX) )GOTO  321 

ID (NMAX) =LD  !  DISTANCE  TO  NEAR  FACET 

NF (NMAX) =1  !  NUMBER  OF  NEAR  FACET 

DO  322  J=1  , NMAX-1 
J1 =NMAX-J 

IF (LD. GE . ID ( J 1 ) )GOTO  321 
ID  ( J1  +1  )  =  ID  ( J1  ) 

NF(J1 +1 ) =NF ( J 1 ) 

ID  ( J1  )  =LD 
NF ( J 1 )=I 

322  CONTINUE 

321  CONTINUE 

C  BEGIN  SEARCH  FOR  BEST  FACET 

323  DO  100  IC=1 , NFMX 
I  _ic 

IF( ITRY. EQ. 1 ) GOTO  324 

IF(NF(IC) .LT. 1 . OR. NF( IC ) . GT . IFMAX)GOTO  100 
I=NF ( IC ) 

C 

324  IFC1  =IFC  (1,1) 

IFC2=IFC (1,2) 

IFC3=IFC (1,3) 

ICW=0  '.SET  FLAG  TO  SIGNIFY  ORDINARY  FACET  CHECK 
C 

C  FIND  IP  TOUCH  VECTOR  PIERCES  FACET  (IPBIRC) 

C  FIND  WHICH  WAY  FACET  IS  FACING  POINT  (LOUTF) 

C  FIND  DISTANCE  BETWEEN  POINT  AND  FACET  PLANE  ALONG 
C  TOUCH  VECTOR  (PDIST) 

CALL  PIERC ( IPS , IFC1  , IFC2 , IFC3 , IPIERC , LOUTF , 

1  PDIST, ICW) 

C 

C  DECIDE  IF  FACET  IS  BEST  SO  FAR 
C 

C  CHECK  I?  DIRECTION  VECTOR  POINTS  FOWARD  THRU  FACET 
IF  (IPIERC. LE.O)GOTO  40 
C 

C  REJECT  POINT  IF  FACET  FACES  TOWARD  TOUCH  POINT 
IF  (LOUTF. GE.O)GOTO  38 
IB=0 

TYPE  *, 'NEGATIVE  PIERCING  FACET' 

GOTO  52 
C 

C  COMPARE  TO  BEST  FACET 

38  IF  (IPRC1  .LE.O. OR. PDIST. LT.PD1 )G0T0  60 

GOTO  50 

£ 

C  REJECT  ALL  OTHER  FACETS  IF  BEST  IS  PIERCED  POSITVE 
40  IF  (INTPNT.EQ. 1 )GOTO  50 

C 

C  CHECK  CASE  WHERE  DIRECTION  VECTOR  POINTS  AWAY  THRU  FACET 
IF  (IPIERC. EQ.0)G0T0  45 
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IP  (PDIST.GT.O)  GOTO  50 
IP  (LOUTF.EQ. 1 )GOTO  50 
IF  (IPRC1 . EQ. 0)G0T0  60 
IF  (PDIST.LT. PD1 )GOTO  50 
GOTO  60  !  GO  FOR  FURTHER  TESTS 

C  CHECK  CASE  WHERE  DIRECTION  VECTOR  DOESNT  PIERCE  FACET 
45  IF  (LOUTF.EQ. 1 )GOTO  50 

IF  ( IPRC1 . NE.O )GOTO  50 
C 

C  FIND  DISTANCE  TO  CENTROID  OF  FACET 

?XA= (M ( IFC1 ,1 )+M ( IFC2 , 1 )+M(IFC3.1 ) ) /3 . -M ( IPS , 1 ) 

FYA= (M ( IFC1 , 2 )+M ( IFC2 , 2 )+M ( IPC3 , 2 ) ) /3 . -M ( IPS , 2 ) 

FZA= (M ( IFC1 ,3)+M(IPC2,3)+M(IFC3,3) )/3.-M (IPS, 3) 

DL=SQRT (FXA*FXA+?YA*FYA+FZA*FZA) 

IF  ( DL 1 . EQ.O )GOTO  60 

IF  (DL1  .  LE.DL)GOTO  50  '.REJECT  IF  NOT  NEAREST  SO  FAR 
C 

C  CHECK  PIERCING  OF  OLD  FACETS  BY  NEW  LINES 
60  DO  310  J»1 , IFMAX 

C  SET  FLAG  TO  CHECK  PIERCING  OP  LINE  SEGMENT  THROUGH  FACET 
ICWF=4 

CALL  PISRC ( IPS , IFC1  ,IFC(J,1 ),IFC(J,2), 

1  IFC ( J, 3) ,  LOT. PDD, ICWF) 

IF ( ICWF. EQ. 6 )GOTO  50 

CALL  PIERC (IPS, IFC2 , IFC ( J, 1 ) ,IFC(J,2)  , 

1  I?C(J,3), LOT, PDD, ICWF) 

IF( ICWF. EQ. 6 ;GOTO  50 

CALL  PIERC (IPS,IFC3,IFC(J,1 ),IFC(J,2) , 

1  IFC (J,3) ,LOT. PDD, ICWF) 

310  IF ( ICWF. EQ. 6 )GOTO  50 
C 

C  CHECK  PIERCING  OF  NSW  FACETS  BY  ALL  OTHER  TOUCH  VECTORS 
DO  51  J  =  1  ,  IPS 
ICWF=0 
IPP=0 

CALL  PIERC ( J, IPS, IFC2 , IFC3 , IPP, LOT , PDD,  ICWF) 

IF ( IPP. GT. 0 ) GOTO  50 

CALL  PIERC (J, IPS, IFC3 , IFC1  , I ?P, LOT , PDD, ICWF) 

IF ( IPP.GT .0 )GOTO  50 

CALL  PIERC (J, IPS, IFC1  ,  IFC2 , I ?P, LOT , PDD, ICWF) 
IF(IPP.GT.O)GOTO  50 

51  CONTINUE 

C  SAVE  POINT  AS  BEST  SO  FAR  AND  SAVE  ALL  ITS  ATTRIBUTES 

IF ( IPIERC . EQ.O ) DL1 =DL 
PD1 =PDIST 
IPRC1 = I PIERC 

IBxI  !  NUMBER  OF  BEST  FACET 

50  CONTINUE 

100  CONTINUE 

C  RETURN  IF  NO  GOOD  FACET  IS  FOUND 

IF ( IB. EQ.O . AND. I TRY. EQ.O ) GOTO  326 

52  IF( IB. NE.O )GOTO  10 
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IPS=IPS-1 

IP ( IRX. EQ. -4 ) WRITE (5 , 234 ) 

234  FORMAT ( '  ***+*REJECT  POINT*****') 

RETURN 

326  ITRY=1  !  MAKE  SECOND  TRY  BY  CHECKING  ALL  FACETS 
NFMX=IFM AX 
GOTO  323 

n 

C  DRAW  LINES  FROM  NEW  POINT  TO  CHOSEN  FACET 
10  DO  55  1  =  1  ,3 

55  CALL  VECT(IPS,IFC(IB,I) ) 

CALL  MGSEND 
C 

C  GET  RID  OF  OLD  FACET  AND  ADD  3  NEW  ONES 
IFC ( IFMAX+1 ,1 )=IPS 
IFC (IFMAX+2, 1 )=IPS 
IFC ( IFMAX+1 , 2 )  =IFC ( IB , 2 ) 

IFC ( IFMAX+2, 2)=IFC(I3,3) 

IFC (IFMAX+1 , 3 ) =IFC ( IB, 3 ) 

IFC ( IFMAX+2, 3)=IFC(IB,1 ) 

IFC (IB, 3 )=IPS 
I FMAX= IFMAX+2 
C 

C  SELECT  FACET  PAIRS  FOR  CHECKING  SMOOTHNESS 
C 

DO  181  1=1 ,30 

181  NX( I )=0  ! LIST  OF  POINTS  TO  CHECK  AROUND 

NX( 1 )  =  IPS 

NX(2 ) =IFC (IB , 2 ) 

NX(3 )=IFC ( IB, 3 ) 

NX(4 ) =IFC ( IFMAX, 2 ) 

NA=4 

NEND=0 

140  IF(NA.GT.30)NA=30 
NX1 =NX(NA) 

NA=NA-1 

K1  =0 

DO  182  1=1 ,30 

182  IF (NX1 . EQ. NX( I ) )K1 =K1 +1 
IF (K1 .GT.3)G0T0  143 

DO  141  1=1 , IFMAX 
DO  142  J  =  1  ,3 

IF (NX1 .  NE. IFC( I, J ) )GOTO  142 
K1 =NX1 

K2=IFC ( 1 , 1 +MOD( J, 3 ) ) 

CALL  FACE(K1 ,K2) 

NEND=NEND+1 

IF(NEND.GT.50)G0T0  144 

142  CONTINUE 

141  CONTINUE 

143  IF (NA.GT .0 )GOTO  140 

144  RETURN 


-110- 


I 


END 

SUBROUTINE  FACE(K1,K2) 

DIMENSION  IA  (4 ) 

COMMON  /DMABUF/  I  DIM  (3 1 00 )  ,  IPC  (200, 3 }  ,M  (1  00,  3 ) 
COMMON  /PACT/  IPMAX, NX (30 ) , NA , IPS, NCON, NPOL 
COMMON  /IPTPS /  IANG(1  00,2), ICHECK, VEX, IPCC 
C  FIND  ALTERNATE  SET  OP  POINTS  Ml, M2 
C  ISTICK=0 

IPCC=0 

IF (K1 . EQ. K2) RETURN 
IF  (K1 . EQ . 0 . OR . K2 . EQ . 0 ) RETURN 
556  IF (K1 . LT.K2)G0T0  5 

IFACE1 =K1 
K1=K2 
K2=IFACE1 
5  IFACE1  =0 

CALL  SEARCH(K1 ,K2,M1 ,IFACE1  ) 

CALL  SEARCH(K2,K1 ,M2, IFACE2) 

IF ( M 1 . EQ . 0 . OR . M2 . EQ . 0 ) RETURN 
70  IF ( ICHECK. EQ.1 ) WRITE(5 , *)K1 ,K2, 

IF (Ml .EQ. M2) RETURN 
CALL  SEARCH(M1 ,M2, J, I) 

IF ( J.NE.O ) RETURN 

C  IF  ICHECK=2  FORCE  FACET  CHANGE 
IF( ICHECK. EQ. 2 )GOTO  160 
C 

C  FIND  ATRIBUTES  OF  COMPLIMENT  FACETS 
90  CALL  PIERC (K1 ,M1 ,M2 , K2 , I PRC 3 , L0UTF2 , PDIST, ICW3 ) 

CALL  PIERC (K2,M2,M1  , K1 , IPRC4 , L0UTF5 , PDIST , ICW4 ) 

C  IF  ICHECK=1  THIS  SUBROUTINE  ONLY  PRINTS  THE  FACET  DATA 
IF ( ICHECK. NE.1 )G0T0  689 
TYPE  *, ' POINT  LOUTF  ICW  IPIERC ' 

WRITE(5,*)K1 , L0UTF2 , ICW3 , IPRC5 
WRITE (5,  *)K2,LCTJTF3,  ICW4  ,  IPRC4 
689  IF ( IPRC3 . LE .0 . AND. IPRC4 . LE.O ) GOTO  155 
1ST ICX=1 

IF (L0UTF2.GT.0) RETURN 
C 
C 

C  CHECK  IF  TOUCH  VECTOR  AND  FACET  NORMAL  ARE  OVER 
C  90  DEGREES  APART 

155  IF(ICW3. NE.1  .AND. ICW4. NE.1  )GOTO  159 

IF (L0UTF2 . EQ. -1 ) RETURN 
GOTO  157 
159  A1  =0 

A2=0 

C  FIND  THE  4  PERIPHERY  POINTS 

CALL  SEARCH (K1 ,M1 ,M1 1,1) 

CALL  SEARCH (Ml  ,K2, Ml  2,1) 

CALL  3 E ARCH (K2, M2, M2 2, I) 

CALL  SEARCH (M2 , K 1 , M2 1,1) 

C  FIND  ALL  THE  SURFACE  NORMALS 
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CALL  CR0SS(K1 , K2.M1 , 1 ) 

CALL  CROSS (K2,K1 ,M2,2) 

CALL  CROSS (Ml ,M2,K2,3) 

CALL  CROSS (M2, Ml ,K1 ,4  ) 

CALL  CROSS (XI ,M1 ,M1 1 ,5) 

CALL  CROSS (Ml ,K2,M1 2,6) 

CALL  CR0SS(X2,M2,M22, 7) 

CALL  CROSS (M2 , XI ,M21 ,8) 

C  FIND  ANGLE  BETWEEN  ADJACENT  FACETS  AND  ADD  TOGETHER 
CALL  ANGL (6 , 1 ,A1  ) 

CALL  ANGL (7 , 2,  A1  ) 

CALL  ANGL (8, 2, A1  ) 

CALL  ANGL (5,1 , A1 ) 

CALL  ANGL (5, 4, A2) 

CALL  ANGL(6,3,A2) 

CALL  ANGL (7, 3, A2) 

CALL  ANGL (8, 4, A2 ) 

CALL  ANGL(1 ,2, A1  ) 

CALL  ANGL(3,4,A2) 

420  IP(ICHECX.NE.1 )GOTO  421 

TYPE  *, 'ORIGINAL  ANGLE  T0TAL=',A1 
TYPE  *, ' COMPLIMENT  ANGLE  T0TAL=’,A2 

421  IF(A1 .LE.A2) RETURN 
C 

C  CHECX  IF  NEW  LINE  PIERCES  ANY  FACETS 

157  CALL  PIERC (Ml , X2 , XI ,M2, IPRC3,L0UTF1 , PD 1ST, ICW3 ) 

CALL  PIERC(M2,X1 ,K2,M1  , IPRC4 , L0UTF1 ,PDIST,ICW4) 

IF ( ICHECK. NE. 1 )G0T0  156 

TYPE  *, 'POINT  LOUTF  ICW  IPIERC' 

WRITE (5 >  *)M1 ,L0UTF1 ,ICW3,IPRC3 
WRITE  (5  ,  *)M2 ,  L0UTF1  ,ICW4,IPRC4 
RETURN 

156  IP(IPRC3.LE.O.AND.IPRC4.LE.O)GOTO  158 

IF(L0UTF2.EQ.1 ) RETURN 

158  IF  ( (ICW3 .  EQ.  1 .0R.ICW4.EQ.1  ) .  AND.  L0UTF2 .  EQ.  -1  )  RETURN 
DO  160  1  =  1  ,  IFMAX 

ICWF=4 

CALL  PIERC (Ml  , M2 , IFC( 1, 1 ) , IFC ( I, 2) , IFC (I, 3 ) , 

1  L0UTF1 ,PDIST.ICWF) 

IF ( ICWF . EQ. 6 ) RETURN 
160  CONTINUE 

CHECK  IF  ANY  LINES  PIERCE  NEW  FACETS 

DO  568  1=1 , IFMAX 
DO  569  J=1  ,3 
XXI =IFC ( I , J ) 

XK2=IFC ( 1 , 1 +MOD ( J , 3 )  ) 

IF (XXI .GE. XX2 )GOTO  569 
ICWF=4 

CALL  PIERC (XXI ,KK2,K1 ,M2,M1  ,L0UTF1  , PDIST, ICWF) 

IP ( ICWF. EQ. 6) RETURN 

CALL  PIERC (XXI , KX2, K2, Ml ,M2,L0UTF1 , PDIST, ICWF) 
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IP ( ICWF. EQ. 6 ) RETURN 

569  CONTINUE 

568  CONTINUE 

C 

C  CHECK  IP  ANY  TOUCH  VECTORS  PIERCE  NEW  FACETS 
IF ( ISTICK. EQ. 1 )GOTO  570 
ICWF=0 

DO  570  1=1 , IPS 

IP(I.EQ.K1 . OR. I . EQ. K2. OR. I . EQ. Ml  . OR. I . EQ. M2 )GOTO  570 
CALL  PIERC(I,K1 ,M2,M1 ,IPRC1 .LQUTF1 ,PDIST,ICWF) 

IF ( IPRC1  . EQ. 0)GOTO  571 
IF(PDIST.GT.O)RETURN 

571  CALL  PIERC ( I,K2,M1 ,M2, IPRC1 , L0UTF1 , PD 1ST, ICWF) 

IF ( IPRC1 .EQ.O)GOTO  570 
IF (PDIST. GT .0)RETURN 

570  CONTINUE 
IFCC=1 


C 

C  RECORD  NEW  FACETS 

IFC (IFACE1 , 1 ) =K1 
IFC ( IFACE1 , 2 ) =M2 
IFC  (IFACE1 , 3)=M1 
IFC (IFACE2, 1 ) =K2 
IFC ( IFACE2 , 2) =M1 
IFC ( IFACE2 , 3 ) =M2 

C 

C  RECORD  NEW  LINES  TO  BE  CHECKED 
NA=NA+4 

IF(NA.GT.30)G0T0  300 

NX(30)=M1 

NX(29)=M2 

NX(28)=K1 

NX (27 ) =K2 

DO  161  J=1  ,4 

KX1 =NX(30) 

DO  161  1=1 ,29 
KK2=NX( I ) 

NX( I )=KK1 
KX1 =NX( 1+1  ) 

NX (1+1 )=KK2 

161  CONTINUE 

C 

C  DRAW  NEW  POLYHEDRON 

300  CALL  LDPTRO (NCON) 

DO  310  1=1 , IFMAX 
DO  309  U=1 ,5 
IIM1 =IFC(I, J) 

ILM2  =  IFC ( 1 , 1  +MOD ( J,  3 ) ) 
IF(ILM1 . GT . IIM2 )GOTO  308 
CALL  VECT ( ILM1 , ILM2 ) 

308  CONTINUE 

309  CONTINUE 


CONVERTED  FACETS 

Ml 

# 

/I\ 

/  I  \ 

/  I  \ 

K1  *  I  *  K2 
\  I  / 

\  I  / 

\I/ 

* 

M2 
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0  CONTINUE 

CALL  MG3END 
*  -"TURN 
EN  ' 

C  SUBROUTINE  PIEnC 

C  THIS  SUBROUTINE  CALCULATES  3UTE°  BETWEEN  A  VECTOR  AND 

C  A  TRIANGLE.  IN  CuuCH  VECTOR  MODE  IS  THE  TOUCH 
C  POINT  NUMBE..  4ND  K1 -K2-K3  IS  IN.uT  CORNER  POINTS  OP  THE 
C  TRIANGLE.  IN  T„  -  MODE  ICW  WILL  BE  OUTPUT  AS  1  I?  THE 
C  TRIANGLE  KP-K1 -K.  HAS  A  SURFACE  NORMAL  MORE  THAN  90 
C  DEGREES  PROM  THE  TOUCH  VECTOR. 

C  IN  LINE  SEGMENT  MODE,  (ICW=4),‘  KP  IS  INPUT  AS  THE  PRIMARY 
C  END?n”NI  OP  THE  LINE  SEGMENT  AND  K1  IS  THE  SECONDARY 
C  ENDPuiNT  aND  K2-K3-K4  IS  THE  TRIANGLE. 

C 

v  AS  OUTPUT,  }"  =  1  IP  THE  VECTOR  PIERCES  THE  FACET  ON  THE 
C  POSITIVE  SIDE  THE  FACET  AND  K4=-1  IP  IT  PIERCES  PROM 
C  THE  NEGATIVE  SIDt.  K4=0  IP  NEITHER  IS  TRUE.  L0UTF=1  IP  THE 
C  FACET  PACES  AWAY  PRu!  THE  PRIMARY  POINT  OR  TOUCH  POINT  AND 
C  L0UT?=-1  IP  IT  PACES  COWARD  THE  POINT.  PDIST  IS  THE 
C  DISTANCE  PROM  THE  TOUCH  PG.'NT  OR  PRIMARY  POINT  TO  THE 
C  FACET  SURFACE  ALONG  THE  VECTOR. 

C 

SUBROUTINE  PIERC (KP, K1 , K2, K3, K4 , LOUTP, PDIST, ICW) 
DIMENSION  RX(3),RY(3),RZ(3),PX(3) , PY (3 ) , PZ (3 ) , KA (3 ) 
COMMON  /DMABUP/IDUM(3700)  ,M(100,3) 

COMMON  /PACT/  IPMAX, NX(30 ) , NA , IPS, NCON, NPOL 
COMMON  /IPTPS/  IANG(1  00,2) 

DATA  PI/3.1415927 
IP(ICW.NE.4)G0T0  40 
C  LINE  SEGMENT  MODE 
KA  (1  )  =K2 
KA (2 ) =K3 
KA (3 ) =K4 

C  IGNORE  COM PARI SI QMS  IP  ANY  POINTS  ARE  THE  SAME 
DO  41  113=1 ,3 
T? (KA (l TS ) . SQ. K 1 ) RETURN 

41  IP  v  KA  v IIS ) . EQ. KP ) RETURN 

C  FIND  ANGLES  SIMILAR  TO  TOUCH  VECTORS 
RD  X=M ( K 1 , 1  )-M (KP, 1 ) 

RDY=M (K1 . 2}-M(KP, 2) 

RDZ=M ( K 1 ,3)-M(KP,3) 

PGAP=SQRT (RDX*RDX+RDY*RDY+RDZ*RDZ ) 

?G=SQRT ( RDX*RDX+RDY*RDY ) 

IP ( PG. NE.O )GOTO  42 

CTHET=1 

STHET=0 

GO'i'C  A3 

42  CTHET=RDX/PG 
c  HET=RDY/PG 

43  IP  ' PGAP.  NE.O ) GOTO  44 
CPHI =1 
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S?HI=0 
GOTO  50 

4-4  SPHI=RDZ  /PGAP 

CPHI=PG/PGAP 
GOTO  50 
C  ORDINARY  MODE 

C  KP  IS  POINT  WITH  TOUCH  VECTOR 
C  K1,K2,K3  DESCRIBE  THE  FACET 

40  IF(KP. EQ. K1 . OR.KP. EQ.K2. OR.KP. EQ. K3 ) RETURN 

CTHET=COS ( FLOAT ( IANG (KP , 1 ) )*.0001  ) 
STHET=SIN(FL0AT(IANG(KP,  1  ) )*.0001 ) 

CPHI=C OS (FLOAT ( IANG (KP ,  2 )  ) * .0001  ) 
SPHI=SIN(FL0AT(IANG(KP,2) )*.0001 ) 

KA(l )=K1 
KA (2 ) =K2 
KA(3)=K3 

50  DO  30  J=1  ,3 

PX(J)=M(KA(J)  ,  1  ) 

PY(J)=M(KA(J) ,2) 

PZ  ( J  )=M  (KA  ( J) ,  3 ) 

C  GET  POINTS  IN  COORDINATES  OF  KP  POINT  AND 

C  TRANSFORM  COORDINATES  SUCH  THAT  THE  VECTOR  LAYS  ON  THE 
r  Y  AYTq 

RDX=PX(  J  )-M  (KP,  1  ) 

RDY=PY ( J )-M (KP, 2 ) 

RDZ=PZ ( J )-M (KP, 3 ) 

RX(JMCTHET*RDX+STHET*RDY)*CPHI+SPHI*RDZ 
RY ( J )=-STHET*RDX+CTHET*RDY 
RZ ( J )=-(CTHET*RDX+STHET*RDY ) *SPHI+CPHI*RDZ 
30  CONTINUE 

C 

C  CHECK  PIERCING 

C  IF  THE  VECTOR  PIERCES  THE  TRIANGLE,  THE  CORNER  POINTS 
C  WILL  SURROUND  THE  X  AXIS 
IPIERC=0 

T1 =ATAN2 (RY ( 1 ),RZ(1  ) ) 

T2=ATAN2(RY(2) ,RZ(2) )-T1 
T3=ATAN2 (RY (3 ) , RZ (3 ) )-T1 
IF (T2 . LT .0 )T2=T2+2*PI 
IF(T3.LT.0)T3=T3+2*?I 
C 

C  CHECK  IF  TOUCH  VECTOR  IS  GREATER  THAN  90  DEG  FROM  NORMAL 
IF ( ICW. EQ.4 )G0T0  55 

C  IF  THE  TWO  OTHER  POINTS  GO  SEQUENTIALLY  CLOCKWISE  WHEN 
C  LOOKING  DOWN  THE  TOUCH  VECTOR,  THEN  THE  FACET  IS  MORE 
C  THAN  90  DEGREES  AWAY 
ICW=0 

IF (T2 . LT . PI )ICW=1  !  GREATER  THAN  90  DEG 
C 

55  IF (T2 . GT . PI )GOTO  32 

IF ( T3 • GT . PI . AND . T3 . LT . T2+PI ) I?IEHC=1 
GOTO  36 
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I?(T3.LT.PI. AND.T3.GT.T2-PI)l?IERC=1 
co::mTNUE 

CHECK  I?  7 '  ^ET  POINTS  O'JT  OR  III 
FIND  Cl. OSS  PRODUCT  OP  F^E'"1 
DO  403  1=2  ■* 

°X( I ^ =RX( _ ;-RX ( 1  ) 

2.Y  ( I )  =  ;  "T)-RY(1  ) 

408  RZ(I)=R2u  RZO) 

QX=RY (2 ) *R^ (3 )-RZ (2 ) *RY (3 ) 

QY=RZ (2 ) *RX ( 3 ) -RX ( 2 ) *RZ ( 3 ) 

QZ=RX(2 ) *RY (3  J-RY (2 ) *RX(3 ) 

C  D  ’  POSITIVE  IF  FACET  POINTS  AW^Y 
P= ( RX ( 1  )*QX+RY(l  )  *QY+RZ  (1  )  *QZ  ) 

PDIST=1 00000 

IF  (QX. „  "'.0 )  PDIST=D  /QX 

C  L0UTF=1  IF  FACET  FACES  AWAY  FROM  POINT  AND  -1  OTHERWISE 
L0UTP=-1 

IF(D.LT.0 ) LOUT!' s'1 

C  PDIST  IS  DISTANCE  ALONG  TOUCH  VECTOR  TO  FACET  SURFACE 
IF (PDIST . LT .0 ) I?IERC=  -IPIERC 
IF(ICW.NE.4)K4=I?IERC 
IF ( ICW.HE. 4. OR. IPIERC. EQ.O) RETURN 
C  INDICATE  THAT  SEGMENT  PIERCES  FACET 

IF (PDIST. GT.O. AND. PDIST. LT.PGAP)ICW=6 

RETURN 

END 

SUBROUTINE  CROSS (Ml  , M2, M3, 1) 

C  THIS  SUBROUTINE  FINDS  THE  SURFACE  NORMAL  OF  A  FACET 
COMMON  /DMABUF/IDUM(3700) , M ( 1  00,3) 

COMMON  /TVEC/  TX(8) , TY (8) , TZ (8) 

A1 =M (M2 , 1  )-M (Ml , 1  ) 

A2=M (M2 , 2 )-M (Ml ,2) 

A3*M(M2,3)-M(M1 , 3) 

B1=M(M3,1  )-M (Ml , 1 ) 

B2=M (M3, 2 )-M (Ml ,2) 

23 =M (M3, 3  )-M (Ml ,3) 

TX(I)=A2*B3-A3*B2 
TY(I)=A3*B1 -A1 *33 
TZ (I )*A1 *B2-A2*31 
RETURN 
END 
C 

SUBROUTINE  ANGL ( I , J f  A ) 

C  THIS  SUBROUTINE  FINDS  THE  ANGLE  BETWEEN  TWO  VECTORS 
COMMON  /TVEC/TX (8 )  ,TY(8)  f  TZ  (8 ) 
R=TX(I)*TX(J)+TY(I)*TY(J)+TZ(I)*TZ (J) 

SI  =3QRrT’(  (TX(I)*TX(I)+TY(I)*TY(I)+TZ(I)*TZ(I)  )  ) 
S2=SQRTv(TX(J)*TX(J)+TY(J)*TY(J)+TZ(J)*TZ(J) ) ) 

B  R/(S1*S2) 

IF v ABS (B) .GT .  1  ) TYPE  *, ’ERROR  IN  ANGL’ 

3=A3S ( ACOS ( 3 ) ) 
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A=A+3 

RETURN 

END 

C 

SUBROUTINE  SEARCH(N1  , N2 , N3 , N4 ) 

C  THIS  SUBROUTINE  FINDS  THE  3RD  POINT  OF  A  FACET  GIVEN  THE 
C  OTHER  TWO  IN  SEQUENCE.  IT  ALSO  RETURNS  THE  FACET  NUMBER. 
COMMON  /DMABUF/  IDUM (31 00 ) , IFC (200 , 3 ) 

COMMON  /FACT/  IFMAX, NX(30 ) , NAf IPS 
N3=0 

DO  10  1=1 , IFMAX 
J=0 

IF (N1 . EQ. IFC (1,1 ))J=1 
IF (N1 . EQ. IFC ( I, 2 ) ) J=2 
IF (SI • EQ. IFC (1,3) )  J=3 
IF(J.EQ.O)GOTO  10 

IF (N2. NE. IFC ( I , 1 +MOD ( J , 3 ) ) )GOTO  10 
N3=IPC(1, 1 +MOD ( J+1 ,3)) 

N4=I 

RETURN 

10  CONTINUE 

RETURN 
END 
C 

SUBROUTINE  VECT(I1 ,12) 

C  THIS  SUBROUTINE  DRAWS  A  LINS  BETWEEN  TWO  TOUCH  POINTS 
COMMON  /DMABUF /IDUM  (3700)  ,M(100,  3) 

10  CALL  M0VI3(M(I1 ,1 ),M(I1 ,2),M(I1 ,3  ) 

CALL  DRWI3 (M ( 12 , 1 ) ,M( 12, 2) ,M( 12, 3)  ) 

RETURN 

END 
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APPENDIX  D.  SUBROUTINES  POP  ST  'P..AY  MANAGEMENT 

SUBROUTINE  DIS? 

D I” ENSIGN  T  ( 7  )  ,  D  T  ( 7  ) 

_  'TE  IB’JF(3) 

CC.  M  "'N  / DM A3UF /  IDUM  (3 1  00 )  ,  IFC  (200 , 3  )  ,'A  ( 1  00 , 3 ) 

com:: on  /iptps/  iang'ioo.2)  ,ickeck, vex, ifcc 

COMMON  /EA?"  ■ '?MAX,  NXou;  ,UA.  I‘  : , NOON, NPOL,  ICC II , 

1  TVECT.ISIK'.IRX 

"  OMH  . ..  1 3PL  / 1  CM ,  XXD ,  XYD ,  XZ  D ,  XT  D ,  Y  XD ,  Y  YD ,  YZ  D ,  Y  T  D , 

1  ZXD , ZYD , u -  ^  ISHAQ, I ARM , IWALL, TROLL, J3TICK, IDCTR 
DATA  INTPN. , INWALL, INARM  /I  3, 1 3, 1 3/ 

C  DRAW  INSTRUCTIONS 

IF  ( I  CM  .  EQ.  "1  *,  3.0R.IRX.3Q.-5)G0T0  208 

.►iX=n 

IQS=0 

I? ( ICM • NE . " 1 1 7)G0T0  733 
0  INITIATE  JOT  *ICK  ROTATIONS 
IQS=1 

IF ( JSTICK.  SO  0)  JSTICK=-1  !  JOYSTICK  FLAG 

JSTICK=-JSTIOK 
IF  ( J3TICK.  NE.  1  )  xR0LL=0 
733  IF( JSTICK.NE. 1 )GOTO  ,10 

IR0LL=1 

CALL  <7R0L(TX,  TY,  TZ  ,  IQS  ) 

IF ( IQS . EQ. -1 ) JSTICK=-J3TICK 
IF ( JSTICK. NE. 1 ) IR0LL=O 

300  IF (ICM . NE. "1 25 ) GOTO  301 
C  INITIATE  SCREEN  OSCILLATIONS 

TYPE  INPUT  CYCLES/SEC  AND  MAX  ANGLE’ 

ACCEPT  *, PER, OSC 
0SC  =  0SC/360. 

PER=PER*6 . 283 
T0S=SECNDS (0.0) 

I ROLL= 1 

C  CHECK  TWO  KEY  COMMAND  CONDITION  FLAG 

301  IF ( ICM . NE. 0 . AND. IPCON. EQ. 1 )GOTO  700 
IF (ICM . NE.O . AND. I PC ON. EQ. 2 ) GOTO  800 
iWlCM.FQ. "1 20 ) IPC0N=2 

IF ( ICM . EQ. "1 31 ) IPC0N=1 

I?{ JSTICK. EQ. 1 ) RETURN 

IF (I CM. EQ. "1 31 . OR.ICM.SQ. ”  1  20) RETURN 

IF ( ICM. EQ. ”040) GOTO  400  !  STOP  ROTATIONS 

IF( TROLL. EQ. 1 )GOTO  200  !  SKI?  FOR  ROTATIONS 

IF(ICM.EQ. ”1 32)ST0P 

IF  ICM.EQ. "1 23)IRX=-1  !  REDRAW  DISPLAY 

IF ( ICM . NS. " 1 1 5 )GOTO  458  !  SET  INTENSITY  OF  MANI? 

INARM  =M0D(1  +INARM.1  6) 

CALL  MODIFY ( I ARM ) 

CALb  SETINT(INARM) 

438  IF ( ICM . NS. " 1 27) GOTO  459  !  SET  INTENSITY  OF  WALLS 

7  WALL=MOD (1 +INWALL, 1 6) 

On  CL  MODIFY (IWALL) 
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459 

CALL  SET INT (INWALL) 

IF (ICM .NE. " 1 1 1 )G0T0  461 

!  SET  INTENSITY  OF  POINTS 

461 

INTPNT=M0D ( 1 +INTPNT,  16) 
CALL  MODIFY (NC0N-1 ) 

CALL  SET INT ( INTPNT ) 
IF(ICM.EQ. "122) IRX=-2 

!  INITIALIZE  PROGRAM 

IF (ICM.EQ. "1 10)IRX=-4 

!  STOP  QIC 

602 

IF (IRX.LT.O) RETURN 

IF ( ICM . NE. "067 ) GOTO  603 

SET  TOP  VIEW 

603 

V?1=0 

VP2=- . 75 

VP3=0 

IF ( ICM .NE. "061 )GOTO  604 

!  SET  FRONT  VIEW 

VP1 =-.75 

604 

V?2=0 

V?3=0 

IF(ICM.NE. "060) GOTO  605 

!  CENTER  PICTURE 

605 

TX=0 

TY=0 

TZ=0 

IF ( I CM. NS. "065 ) GOTO  200 

!  SET  SIDE  VIEW 

200 

V?1=.5 

V?2=0 

VP3=0 

IF (ICM .NE. " 1 1 4 )GOTO  618 

!  SET  NORMAL  VIEW 

VP1 =-.55 

V?2=.04 

VP3=0. 

S=1  . 

618  IF(ICM.SQ."070)DT(l )=.0008  !  SET  ROTATION  SPEEDS 

IF ( ICM . EQ. "062 )DT ( 1 )=-.000S 
IF ( I CM . EQ. "064 )DT (2 ) = .0008 
IF (ICM.EQ. "066)DT  (2)=-. 0008 
IF(ICM.EQ. "1 05 ) DT (6 ) = . 0008 
IF (ICM.EQ. "124 )DT (6)=-. 0003 
IF (ICM.EQ. "075)DT(3)=10. 

IF ( ICM.EQ. "047 )DT (3) =-10. 

IF(ICM.EQ."133)DT(4)=10. 

IF  ( ICM .  EQ.  "  1  34  )DT  (4  )  =-1  0 . 

IF(ICM.EQ."073)DT(7)=10. 

IF (ICM. EQ. "1 73 )DT (7)=-10. 

IF (ICM.EQ. "071 )DT (5 )= .004 
IF (ICM.EQ. "063 )DT (5) =--004 
DO  450  1=1 ,7 

450  IF(4BS(DT(l)) .GT. .00001 JlR0LL=1 
J=0 

DO  451  1=1  ,7 
T (I )=T (I  )+DT (I ) 

451  IF(T ( I ) . NE.O ) J=J+1 

IF ( J . EQ. 0 . AND. PER. EQ. 0 . ) I R0LL=0 
460  VP3=V?3+T (6) 

7P2=VP2+T  (1  ) 
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452  D T  1. 1 )  =0 

I  CM  =0 

201  J?1--CIN(V?T*6.28) 

3?2=SIN (V?2*6 . 23) 

CPI  =C0S  (V?T*6 . 28) 

C?2  =  Cow  'V?2*6.28) 

CP3=C OS (7 03*6.26) 

SP3*3IN(V?3*-'  28) 

C  CALCULATE  SCREEN  TRANSFORMATIONS 

:cxd=cpi  *c?3*s 

XYD=C?1 *3?3*3 
XZD=-3P1 *3 

XTD= (TX*XXD+TY*XYD+TZ*XZD ) 

YXD  = (-CP2*S?3+SP2*SP1 *C?3)*3 
YYD= (C?2*CP3+S?2*S?1 *SP3^*S 
YZD=SP2*CP1 -3 

YTD= (TX*YXD+TY*YYD+TZ*YZD ) 

ZXD=(S?2*SP3+CP2*SP1 *C?3)*S 
ZYD= (-S?2*CP3+CP2*3?1 *3P3) *S 
ZZD=C?2*C?1 *S 
RETURN 

400  DO  401  1  =  1  ,7 

401  TU)=0 
RETURN 

C  INITIATE  POLYHEDRON  CONSTRUCTION 

700  IF ( ICN . N3. ” 1 07 ) GOTO  701 

CO."  LDPIRO (NCON) 

IFMAX=0 

ICCN=1 

IPS=0 

DO  12!  J=1 ,3 
DO  1 21  1=1 ,100 
M ( I , J ) =0 
IFC  ( I ,  J  )  =0 
IFC ( I *2 , J ) =0 
IF (J. EC. 3 )GOTO  121 
IANO(I, J)=0 
121  CONTINUE 

701  IF( ICM. NH. " 1 22) GOTO  703  !  RESTART  POLYHEDRON 

i  C=IPST 

ICCN=1 
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703  IF ( I CM .NE. " 1 27) GOTO  704  !  REDRAW  WALLS 

DO  705  1=1 , IFMAX 

779  DO  705  J=1 ,3 

IF ( IFC ( I,  J ) .GT . IFC (1,1  +MOD ( J ,  3 )  ) )G0T0  705 
CALL  VECT ( IFC ( I , J ) , IFC ( I , 1 +KOD ( J , 3 ) ) ) 

705  CALL  MGSEND 

704  IF ( ICM . NE. "  1  01 ) GOTO  70!  CONNECT  POINTS  ALREADY  READ 
CALL  LDPTRO (NOON ) 

ICCN=1 

DO  777  1=1 , IFMAX 
DO  777  J=1  ,3 
777  IFC ( I, J)=0 

IFMAX=0 
IPST=IPS 
DO  707  1=1 , IPST 
IPS  =  I 

707  CALL  CON 

706  IF ( ICM. NE. " 1 24 ) GOTO  708  !  DRAW  TOUCH  VECTORS 
DO  709  1=1 f IPS 

CALL  M0VI3 (M (1 , 1 )  ,  M  ( 1 , 2  ) .  M  ( 1 , 3  )  ) 

CTHET=C0S (FLOAT (IANG( 1, 1 ) )*.0001  ) 

STHET=S IN (FLOAT (IANG( I , 1 ) )*.0001 ) 

C  PHI=C  OS ( FLOAT ( I ANG ( 1 , 2 ) ) * . 000 1  ) 

S?HI=SIN (FLOAT ( IANG( I, 2 ) ) *. 0001 ) 

MXX=1 00 . *CTH3T*CPHI+M (1,1 ) 

MYY=1 00. *STHET*CPHI+M(I, 2) 

MZZ=1 00 . *SPHI+M (1,3) 

709  CALL  DRWI3 (MXX, MYY, MZZ ) 

CALL  MGSEND 

C  DRAW  CONTOURS 

708  IF(ICM.NE."103. AND. ICM.NE."  1  10)G0T0  781 

MYY=50 

IF ( ICM. EQ. " 1 03) GOTO  710 
WRITE (5, 783) 

783  FORMAT ( '  INPUT  NUMBER  OF  SECTIONS') 

READ (5 » *)MYY 
782  CALL  CT OUR (MYY) 

710  IF(ICM.NE."1 2O)G0T0  711  !  CHECK  IF  FACETS  FOLD 

ICW5=0 

DO  713  1=1 , IFMAX 
DO  713  J  =  1  ,  IFMAX 
DO  713  K=1  ,3 
MYY=IFC(J,K) 

MZZ=IFC(J,1+M0D(K,3)) 

IF (MYY. GE. MZZ )GOTO  713 
MXX=4 

CALL  PIERC(MYY,MZZ, I, I, CPI , CP2,SP1 ,MXX) 

IF(MXX.  NE.  6  )GOTO'  713  * 

ICW5=ICW5+1 

WRITE (5  »  714 ) MYY, MZZ , IFC (1, 1 ) , IFC ( 1 , 2 ) , IFC ( I, 3 ) 

714  FORMAT (’  LINE’, 14,'  TO ’,14,'  PIERCES  FACET ',314) 

713  CONTINUE 
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71  1 


433 

716 

1  2 
715 


718 

719 
717 


725 
729 

726 
728 


72,’ 


IF( ICM . NE. " 1 06 ) GOTO  715  !  r.  CHECK  FACETS 

MZ2=0  !  FOR  SMOOTHNESS 

^0  7*6  1=1  ,  IFMAX 
Ov-  433  T  =  1  ,3 

MXa-_TC ( I, J ) 

MYY=IFC  ( 1 , 1  +M<',D  ( J,  3 )  ) 

IF  (MXX.  GE  Y__;jOTO  433 
IFvir^C.E^.I )MZZ=MZZ+1 
vnLL  Frt«.  'MXX.MYY) 

CONTINUE 
CONTINUE 
WRITE  (5, 1  2) HZ'7 

FORMAT (’  OF  FACET  CHANGES* ' ,16 ' 

xF ( I CM . NE . " 1 1 6 ) GOTO  717  !  CRAW  POINT  NUMBERS 

CC  719  1=1  ,  IPS 

CALL  M°VI3 (M ( I, 1 ),M(I,2),M(I,3) ) 

ENCODER.  71  8, 13UF)I 
CALL  CHAR ( IFUF, 3 , 1 ,0) 

FORMAT (13) 

CALL  MGSEND 
CONTINUE 

IF(ICM.NE."1  14)G0T0  r/2 5  LOOK  AT  FACET  PAIR  DATA 
WRITE (5 , 729 ) 

READ(5 , *)K1 ,K2 
ICHECK=1 

CALL  FACE (XI , K2) 

ICHEC  K=0 

IF ( ICM .NE.M  1  1 1 )GOTO  726 

ICHECK=2 

WRITE(5f 729) 

FORMAT ('  INPUT  K1  AND  K2') 

READ (5 , * )K1 , K2 
CALL  FACE (K1 ,K2) 

ICHECK=0 

IF ( ICM . NE. " 1 1 5 ) GOTO  727  !  GET  COORDS  OF  A  POINT 
WRITE (5,723)  !  AND  ITS  TOUCH  VECTOR 

FORMAT ('INPUT  POINT  ') 

fl-Li-  (  0  t  *  ) 

WRITE (5 , *)M(I, 1 ),M(I,2),M(I,3) 

CTHET=COS ( FLOAT (IANG( 1,1 ) ) *.0001 ) 

5THET=S IN (FLOAT (IANG( I , 1 ) )*.0001 ) 

CPHI=COS (FLOAT ( IANG (1,2)) * .0001  ) 

SPHI=SIN( FLOAT ( I ANG( 1,2)) *.0001 ) 
MXX=100.*CTHET*CPHI+M(I, 1 ) 

MYY=1 00. *STHET*CPHI+M (1,2) 

MZZ=1 00 . *SPHI+M ( I , 3 ) 

WRITE (5  *  *)MXX, MYY,  MZZ 

IF ( ICM . NE . ” 1 t  2 ) GOTO  735  !  WRITE  ALL  FACET  DATA 

DO  731  1=1, IFMAX 

WbITE(5,*)IFC(I,1  )  ,IFC(I,2)  ,IFC(I,3) 

C  <  NTINUS 

IF  ^ ICM . NE. ” 1 30 ) GOTO  736  !  CHECK  IF  ANY  TOUCH  VECTORS 
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731 

735 


'P 


DO  737  1  =  1  ,  IFMAX  !  PIERCE  THE  P  )LYHEDRON 

DO  733  J= 1 , IPS 

MXX=0 

I?(J. EQ.IPC(I, 1 ) .OR.J.EQ. IFC(I,2) .OR.J.EG. I?C(I, 
1  3) )GOTO  738 

CALL  PIERC ( J , IFC (1,1 ), IFC (I, 2), IFC (I, 3) , CPI , CP2, 
1  SP1.MXX) 

IP (CPI . EQ.  0 . OR. SP1  . LE.O )GOTQ  738 
CP2=SP1  /40. 

WRITE (5 , 739)0, IFC (I, 1 ) , IFC ( I, 2 ) , IFC ( I, 3 ) , CP2 
739  FORMAT ('  VECTOR' ,  14  ,  '  PIERCES  FACET ',314,'  AT', 
1  F9.4,'  INCHES') 

738  CONTINUE 

737  CONTINUE 

736  IPC0N=0 

RETURN 

800  IF(ICM . NE. " 1 04 )GOTQ  802  !  DRAW  POINTS 

DO  803  1=1 ,IPS 

803  CALL  PNTI3 (M (I, 1 ) ,M ( I, 2 ) ,M(I , 3 ) ) 

CALL  MGSEND 

802  IF (ICM.NE. " 1 1 2) GOTO  804  !  DELETE  POINT 

TYPE  *, 'INPUT  NUMBER  OF  POINT  TO  DELETE, 0=SND ' 
ACCEPT  *,MEND 

IF (MEND. EQ. 0. OR. MEND. GT . IPS ) RETURN 
DO  805  I=MEND , IPS 
M (1, 1  )=M (1+1 , 1  ) 

M  ( I,  2 ) =M ( 1+1 , 2 ) 

M (1, 3)=M (1+1 ,3) 

IANG (1,1 ) =IANG ( 1+1 ,1 ) 

805  IANG( 1 , 2 ) =1 ANG( 1+1  ,2) 

IFMAX=0 

IPS=IPS-1 
DO  806  1=1 ,200 
IFC(I, 1 )=0 
IFC  ( I,  2 )  =0 

806  IFC(I, 3)=0 

804  IF( ICM . NE. " 1 03 )GOTO  807  !  CLEAR  ALL  POINTS 

DO  808  1=1 ,100 

DO  808  J=1  ,3 
M ( I , J ) =0 
IFC ( I , J )=0 
IFC  ( 1+1 00  ,  J )=0 
IF(J. EQ. 3)G0T0  808 
IANG(I, J )=0 
808  CONTINUE 

ICCN=0 
IPS=0 
IFMAX=0 

807  IF(ICM.EQ. "1 1 3)ICCN=0  ISTOP  POINT  CONNECTIONS 
IF( ICM.NE. "1 1 4 )GOTO  809  ’WRITE  DATA  TO  FILE 
TYPE  *,  ' FOR  LEXIDATA  "1”  FOR  ?1EGATEK  "2"' 

ACCEPT  * , IWRT 
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810 
SI  1 

809 

814 
813 
81  5 


81  9 
818 


822 

321 

320 


:?(iwrt.e,. i  '.o?en(unit=i 

I?  (  ■  WRT .  EQ .  2  )  OPEN  ( 'JK 12  =  1 
V  its:1 . *)I?3,IFMAX 


NAMS=  ’LEX.  DAT  1  ,TY?S=  ’NEW 
NAM  E- 'MEG. DAT ’  , TYPE= ' HEW ' 


DO  ~ '  0  1  =  1  IPS 

MXX  A ( I 7 1 ' *XXD+M (1,2' *TYD+M (1,3; *XZ D+XTD 
MYY  =M  (1,1)  *v*  -+M  ( I,  2 )  -  i  i  ( I , *YZD+YTD 
VZZ=M  '  1 ,  1  »ZXD+M(If2)*2YD-^w.  x,;,  *ZZD 

’’(iwa  *y;.2)write(i  ,*)>Ax,i  ),m(i,2),m(i,3) 

IP  ( IWRT  •  4  )  WRITS ( 1  , *)MXX,MYY,MZZ 

DO  31 1  1=1 , I PM AX 

WRITE ( 1 , *)I?C(I, 1 ) ,I?C(I,2),IPC(I,3) , 

I AUG (1,1 ) , IANu ( x , 2 ) 
i,OSrf'  UNIT=1  ,  DISrOSS=  1  SAVE  '  ) 

IP  ( ICM .  NS.  "  1  22  )GOTO  815  !  READ  DATA  FRO?!  FILS 
OPEN (UNIT=1  , N  AME= 'MEG. DAT ' ,TY?E='OLD' ) 

READ ( 1 ,  *) IPS, IPMAX 
DO  814  1=  IPS 

READ(1 , * ) M ( I  1 ) ,M ( I , 2 ) ,M ( I, 3) , IANG ( I , 1 ),IANG(I,2) 

do  813  i=i,if:w 

READ ( 1 ,*)IPC(I, . ),:?C(I,2),IPC(I,3) 

CLOSE (UNIT  =  1 , DISPOSE^  SAVE '  ) 

IP (ICM.NE. " 1 1 6 ) GOTO  818  !  ARRANGE  TO  WRITE  LARGE 
IP ( IDOTR. EQ. 1 )GOTO  819  !  LARGE  NUMBER  OP  POINTS 

OPEN (UNIT=2,NAME=' DOT. DAT' ,TYPE='NEW' ) 

ID0TR=1 


GOTO  818 

CLOSE (UNIT=2 , DISPOSE= ' SAVE ' ) 

ID0TR=0 

IP ( ICM . NE. "1  1 5 )G0T0  820!  READ  MORE  THAN  100  POINTS 
0PEN(UNIT=2,NAME='D0T.DAT' ,TYPE= 'OLD' ) 

DO  822  1=1 ,8000 

READ (2, *, END=821 )MMX,MMY,MMZ 

CALL  P NT  13 ( MMX , MMY , MMS ) 

CALL  MGSEND 

CLOSE (UN IT=2 , DISPOSE= ' SAVE ' ) 

TYPE  *,I 
I  PC  0N-n 
RETURN 


C  PRINT  DISPLAY 
208  TYPE  *, ' 


TO  ROTATE  TYPE: ' 

TYPE  *, ’  3=U?  2=D0WN  6=RIGKT  4=LEPT  5=FR0NT 
' 1 =SIDS  7  =TOP ' 

TYPE  *, '  LaORIENTSD  VIEW  E=CW  T=CCW' 

TYPE  *, '  TO  TRANSLATE  TYPE:' 

TYPE*,'  "="=UP, "=DOWN, [=RIGHT, =L EFT, 0=C ENTER, ;  ’, 
’ =FOWARD,  ! =BACK’ 

TYPE  *, •  9=0 OOM  UP  3=Z00M  DOWN,  TYPE  "M" ’ , 

•POh  MANIPULATOR’ 

TYPE  *, 1  TYPE  "S"  TO  ERASE,  "W"  FOR  WALLS,  I  POR  ’ 
’  OINT  I NT  ’ 

TYPE  *,’  TYPE  "Z"  TO  EXIT,  "R”  TO  REPEAT,  "K"  POR 
' INSTRUCTIONS ' 
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.  hV*  Va>  1  • 


TYPE  *, '  TYPE  "H"  TO  HALT  KEYBOARD  ROTATIONS' 

TYPE  ’  C ’ 

TYPE  *, '  "P"  FOR  POINT  MANIPULATION  —  THEN  TYPE' 
TYPE  *,'  N=  READ  POINTS  TO  DOT.  R=HSCALL  POINT 
1  'AND  LINE  DATA' 

TYPE  *, '  TYPE  D=DRAW  POINTS  J=DELETE  SPECIFIC  POINT' 
TYPE  C=CLEAR  EVERYTHING,  K=DOT  ENABLE,  L=SAVS  ', 
1  'FOR  LEX  OR  MEG' 

TYPE  *, '  C' 

TYPE  *, '  FOR  POINT  CONNECTIONS  —  FIRST  TYPE  ' , 

1  »"Y"  THEN-  ’ 

TYPE  *, »  G=START,  S=START  WITH  SURFACE,  B=SUPPR£SS', 
1  '  BASE  POINTS' 

TYPE  E=END,  R=RESUME,  W=REDRAW,  T=TOUCH  ', 

1  'VECTORS,  C=50  CONTOUR' 

TYPE  *, ’  SECTIONS,  H=CONTOUR  SECTIONS,  A=CONNSCT  ', 

1  'POINTS  ALREADY  READ' 

TYPE  V=CHANGE  CONCAVITY  FACTOR  X=CHECK  TOUCH  ’, 
1  'VECTOR  PIERCING' 

TYPE  *, '  P=CHECK  LINE  PIERCING  OF  FACETS  F=CHSCK' , 

1  '  ALL  FACETS' 

TYPE  *, '  I=CHANGE  FACETS, L=LOOK  AT  FACETS, N= ' , 

1  'NUMBER  FACETS' 

TYPE  *, '  M=C OORDS  OF  POINT  J=FACET  NUMBERS’ 

TYPE  *,'  0= JOYSTICK  OR  TRACKBALL’ 

IRX=0 

RETURN 

END 

SUBROUTINE  CTOUR(IS) 

C  THIS  SUBROUTINE  DRAWS  CONTOURS  AROUND  THE  POLYHEDROM 
C  IN  THE  X-Y  PLANE 
C  (IS)  IS  THE  NUMBER  OF  CONTOURS 
DIMENSION  NF(4) 

COMMON  /DMABUF/  IDUM  (31  00) ,  IFC (200,  3)  ,M  (1  00, 3) 

COMMON  /IPTPS/  IANG(100,2) 

COMMON  /FACT/  IFMAX, NX(30 ) ,NA, IPS , NCOH, NPOL,  ICCN, 

1  IVECT , ISUP, IRX 

COMMON  /DISPL/  ICM ,XXD, XYD,  XZD,  XTD,  YXD, YYD, YZD , 

1  YTD,ZXD,ZYD,ZZD, ISHAD, I ARM , IWALL, IROLL 
MAXZ— 2000 
MINZ=2000 

C  FIND  THE  MAX  AND  MIN  Z  VALUES  OF  THE  POLYHEDRON 
DO  10  1=1 ,IPS 

IF(M(I,3).GT.MAXZ)MAXZ=M(I,3) 

10  IF(M ( I, 3 ) • LT .MINZ )MINZ=M (1,3) 

S=FLOAT (MAXZ-MINZ ) /FLOAT (IS+1  ) 

DO  20  1=1 ,IS 

IZ=MAXZ-I*S  !  IZ  IS  THE  GAP  BETWEEN  CONTOURS 
DO  30  J=1 , IFMAX 

C  SEE  IF  FACET  LAYS  ACROSS  THE  CONTOUR  IN  QUESTION 
432  DO  40  K=1 .3 

IF(M(IFC(J ,K) ,3) .GE.IZ. AND. M ( IFC ( J , 1 +MOD (K, 3 ) ) > 

-125- 


4'- 


1  3 )  •  LE.  IZ  )  GOTO  50 

CONTINUE 
GOTO  30 

50  nf;m=ipc(j,i) 

..r(2)  =  IPC(J,2) 

NP(3)=IFC<'J,3) 

NP(4)-i:w(jfi 

:  ^L0AT( (IZ-M(NP(K) ,3' ) ) /FLOAT ( (M (NF (X ) , 

1  3  )-i‘»  *TF(K+1  ),3))) 

IY1 =  (H(NP(K) ,2)-M(NP(K+1 ) ,2) )+M(NF(X) ,2) 
IX1=D*(M(NP(K),1 )-M (NP (K+1 ),1 ))+M(NF(K),1 ) 
CALL  M0VI3 ( 1X1 , IY1 , IZ) 

45  DO  70  K=1 

iP(?;(NF(X),3)  .IB.IZ.AND.M(NP(::i-:  )  ,3)  .GE.IZ)G0T0  80 
GOTO  70 

-0  n=FLOAT ( (IZ-M (NF(X) , 3) ) ) /FLOAT ( (M (NF (X) , 

1  3 „  M (NF(K+1 ) , 3 ) ) ) 

90  IY2=i/ *(M (NF(X)  , 2)-M(NF(X+1  ) ,2) )+M (NF(X) , 2) 

IX2-D*u-I'NF(K) ,  1  )-M (NP (X+1  )  ,1  )  )+M(NF(K)  ,1  ) 

IF  ( IY1 .  EQ  -1900.  AND.  IY2.EQ.-1900)GOTO  70 
CALL  DRWI3 ( 1X2 , Iv2 , IZ ) 

70  CONTINUE 

30  CONTINUE 

CALL  MGSEND 
20  CONTINUE 

RETURN 
END 
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APPENDIX  5.  PROGRAM  FOR  RASTER  DISPLAY  OF  POLYHEDRON 

PROGRAM  DRW 

C  THIS  PROGRAM  DRAWS  A  SHADED  PICTURE  OP  A  POLYHEDRON 
C  GIVEN  THE  3-D  COODINATES  OP  ALL  ITS  POINTS  AMD  ITS 
C  CONNECTIVITY  DATA 

DIMENSION  HP (4) ,M(100,3) ,IFC(200,3) ,NN(200,2) 
DIMENSION  R1 (3),R2(3),IY(3) 

INTEGER  BUFP1 (200) , BUPP2 (200) , BUFF3 (200) 

DATA  MM1,MM2,MM3/255,255,255/ 

C  INITIALIZE  DISPLAY 

CALL  DSOPN (2 , IE) 

CALL  DSCSL(2 , 0, 0 ) 

CALL  DSCER 
CALL  DSCLR(4095) 

15=1 

PI=3.  HI  5 
C  READ  DATA  PILE 

OPEN (UNI T=4,NAME='DL1 : [200, 214 ]0. DAT' ,TYPE  ='OLD' ) 
READ (4 , *) IPS , IPMAX 
DO  400  1=1 ,IPS 

400  READ (4  ,  *)M  ( 1 , 1 ),M(I,2),M(I,3) 

DO  401  1=1, IPMAX 

401  READ (4 , *) IFC (1,1 ) , IFC ( I , 3) , IPC ( I , 2 ) 

CL0SE(UNIT=4 , DISPOSE= ' SAVE ' ) 

IFM=IFMAX 

C  REJECT  ALL  FACETS  THAT  FACE  AWAY 
DO  402  M4  =1 , IFM 
I*IFM-M4+1 

IF (IFC (1,1 ) . EQ.O )GOTO  402 
DO  403  J=1 ,3 

R1 ( J )=M ( IFC (I , 2 ) , J)-M ( IFC (1,1 ) , J ) 

403  R2 ( J )=M ( IFC ( I, 3) , J )-M ( IFC ( I, 1 ) , J ) 

QZ=R1  (1  ) *R2 (2 )-R1  (2 ) *R2 ( 1  ) 

IF ( QZ . LT.O )GOTO  402 
I PM  AX= I FM  AX- 1 
DO  435  J=I , IFM 
DO  435  K=1 ,3 
IFC (J,K)=IFC (J+1 ,K) 

435  CONTINUE 

402  CONTINUE 

C  ORDER  FACETS  SO  NEAREST  ARE  DRAWN  LAST 
DO  405  J=1 , IFMAX 
DO  406  1=1 , IFMAX- 1 
IF ( IFC (1,1 ) . EQ.O ) GOTO  406 

Ml =MAXO(M(IFC(I, 1 ),3),M(IFC(I,2),3).M(IFC(I,3),3)) 
M2=MAX0 (M ( IFC ( 1+1 , t ) ,3) ,M(IFC(I+1 , 2) ,3) , 

1  M( IFC (1+1 , 3) ,3) ) 

IF (Ml .GT.M2)G0T0  406 
407  DO  408  K=1 ,3 

N=IFC ( I,K) 

IFC (I, K)=IFC( 1+1  ,K) 

IFC (1+1 ,K)=N 


408 
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406  CONTINUE 

405  CONTINUE 

C  DRAW  FACETS  AS  2  DIMENSIONAL  TRIANGLES  ON  SCREEN 
DO  409  1=1 f IPS 
NII(I,  1  )=M  (1, 1  )  *4/25+320 

409  NN  ( I,  2  )*-M  ( I,  2 )  *4  /25+256 
DO  410  1=1 , IFMAX 

DO  413  J=1 ,3 

413  IY(J)=J 

DO  411  J=1 ,3 
DO  412  K=1  ,2 

IF (NN ( IFC ( I, IY (K) ) ,2) .LE.NN(IFC(I, IY(K+1 ) ) , 
1  2 ) )GOTO  412 

N«IY(K) 

IY (K) =IY (K+1 ) 

IY(K+1 )=N 
412  CONTINUE 

411  CONTINUE 

IYT  =NN ( IFC ( I ,  I Y  ( 1 ) ) , 2 ) 

IYM=NN(IFC(I,IY(2)  )  ,2) 

IYB=NN ( IFC ( I , IY (3 ) ) »  2 ) 

IXT=NN  ( IFC  (I,IY(1)),1) 

IXM=NN ( IFC ( I , IY(2) ) , 1 ) 

IXB=NN ( IFC ( I , IY (3 ) ) » 1 ) 

IF ( IYB. EQ. IYT )GOTO  410 
IF(IYM.EQ. IYT)GOTO  441 
F=FLOAT ( IYM-IYT ) /FLOAT ( IYB-IYT ) 

440  IX2M=IXT+FL0AT(IXB-IXT  )  *F 
IF( IYB. LT. 1 )GOTO  410 
IF(IYT.GT.51  2)G0T0  410 

DO  414  J=IYT , IYM 

F=FLOAT (J-IYT) /FLOAT (IYM-IYT) 

1X1 =IXT+FLOAT ( IXM-IXT ) *F 
IX2=IXT+FL0AT(IX2M-IXT)*F 
CALL  TRI(IX1 ,1X2, J, I) 

414  CONTINUE 

441  IF( IYB. EQ. IYM )GOTO  410 

DO  415  J  =  I YM  ,  I YB 

F=FLOAT ( J-IYM ) /FLOAT ( IYB-IYM ) 

1X1  =IXM+FLOAT  ( IXB-IXM  )  *F 
IX2=IX2M+FL0AT ( IXB-IX2M ) *F 
CALL  TRI  (1X1 , 1X2,  J,  I ) 

415  CONTINUE 

410  CONTINUE 

C  READ  DATA  FROM  TRACKBALL 
1  CALL  TBALL(IXX, IYY, IZ ) 

IF ( IXX. EQ. 0 . AND . IYY. EQ. 0 . AND . IZ.EQ.O)GOTO  1 

IAX=IAX+IXX*TS 

IAY=IAY+IYY*TS 

IF(IZ.EQ.  1  )GOTO  1 

IF( IZ. EQ.O )GOTO  436 

IF ( IZ . EQ. IS2 )GOTO  1 
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IF(IZ.N3.3)G0T0  437 

TYPE  *, ’INPUT  BACKGROUND  BLUE-GREEN-RED  SHADES , 

1  0-255' 

ACCEPT  *, Ml, M2, M3 

CALL  DSLLU ( 1 024 , Ml ,1 024 ,  Ml ) 

CALL  D3LLU(2048,M2,2048,M2) 

CALL  DSLLU (5072, M3, 3072, M3) 

437  IP (IZ . NE. 6 )GOTO  438 

TYPE  INPUT  OBJECT  3LUE-G KEEN- RED  SHADES, 0-255 ' 
ACCEPT  *,MM1 , MM2, MM3 

438  IP(IZ.EQ.7)CALL  EXIT 

C  CALCULATE  SHADES  FOR  ALL  TRIANGLES 
436  AX=FLOAT ( I AX)  *PI/1  80. 

AY=FLOAT ( IAY ) *PI /I  80 . 

IZ2-IZ 
SX=SIN ( AX) 

SY=COS (AX) *SIN(AY ) 

SS=-COS(AX)*COS(AY ) 

DO  422  1=1  .  IFMAX 

IF ( IFC (1,1  J . EQ.O )GOTO  422 

DO  423  J  =  1  ,3 

R1 ( J  )  =M  ( IFC (1,2) , J )-M ( IFC (1,1 ) , J ) 

423  R2 ( J )=M ( IFC ( I , 3 ) , J )-M ( IFC ( I , 1 ),J) 

QX=R1  (2 ) *R2 (3 )-H1 (3 ) *R2 (2 ) 

QY=R1  (3)*R2(1  )-R1  (1  )*R2(3) 

QZ  =R1  (1  ) *R2 (2 )-R1  (2)*R2(1  ) 

DLEN=SQRT (QX*QX+QY*QY+QZ*QZ ) 

DENS* (QX*SX+QY*SY+QZ *SZ ) /DLEN 

IF(DENS.LT.0)DENS=0 

BUFFI ( I )=DENS*FLOAT (MM1  ) 

BUFF2 ( I ) «DENS*PLOAT (MM2 ) 

BUFF3 ( I ) =DENS*FLOAT (MM3 ) 

422  CONTINUE 
C  SEND  SHADES  TO  DISPLAY 

CALL  DSLWT (1025, IFMAX, BUFFI ) 

CALL  DSLWT (2049, IFMAX, BUFF2) 

CALL  DSLWT (3073, IFMAX, BUFF3) 

GOTO  1 
END 

SUBROUTINE  TRI(IX1 , 1X2, J, I ) 

C  THIS  SUBROUTINE  DRAWS  THE  ACTUAL  LINES  ON  THE  SCREEN 
IF ( J. GT . 51 2) RETURN 
IF ( J.LT . 1 ) RETURN 
IF(IX1 .GT. 640)1X1=640 
IF(lX2.GT. 640)1X2=640 
IF(  1X1 .  LT .  1  )  1X1  =1 
IF ( 1X2 . LT . 1 )IX2=1 
IF( ABS (1X1 -1X2) .LT.  1  ) RETURN 
CALL  DSVEC(IX1 , J,IX2, J,I) 

RETURN 

END 
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